xref: /freebsd/sys/dev/iwi/if_iwi.c (revision 408146ed571e10e5da99b61d90ed29c3091f7128)
1ceaec73dSDamien Bergamini /*	$FreeBSD$	*/
2ceaec73dSDamien Bergamini 
3ceaec73dSDamien Bergamini /*-
4ceaec73dSDamien Bergamini  * Copyright (c) 2004, 2005
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_iwireg.h>
80ceaec73dSDamien Bergamini #include <dev/iwi/if_iwivar.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 __inline uint8_t
200ceaec73dSDamien Bergamini MEM_READ_1(struct iwi_softc *sc, uint32_t addr)
201ceaec73dSDamien Bergamini {
202ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_INDIRECT_ADDR, addr);
203ceaec73dSDamien Bergamini 	return CSR_READ_1(sc, IWI_CSR_INDIRECT_DATA);
204ceaec73dSDamien Bergamini }
205ceaec73dSDamien Bergamini 
206ceaec73dSDamien Bergamini static __inline uint32_t
207ceaec73dSDamien Bergamini MEM_READ_4(struct iwi_softc *sc, uint32_t addr)
208ceaec73dSDamien Bergamini {
209ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_INDIRECT_ADDR, addr);
210ceaec73dSDamien Bergamini 	return CSR_READ_4(sc, IWI_CSR_INDIRECT_DATA);
211ceaec73dSDamien Bergamini }
212ceaec73dSDamien Bergamini 
213ceaec73dSDamien Bergamini static int
214ceaec73dSDamien Bergamini iwi_probe(device_t dev)
215ceaec73dSDamien Bergamini {
216ceaec73dSDamien Bergamini 	const struct iwi_ident *ident;
217ceaec73dSDamien Bergamini 
218ceaec73dSDamien Bergamini 	for (ident = iwi_ident_table; ident->name != NULL; ident++) {
219ceaec73dSDamien Bergamini 		if (pci_get_vendor(dev) == ident->vendor &&
220ceaec73dSDamien Bergamini 		    pci_get_device(dev) == ident->device) {
221ceaec73dSDamien Bergamini 			device_set_desc(dev, ident->name);
222ceaec73dSDamien Bergamini 			return 0;
223ceaec73dSDamien Bergamini 		}
224ceaec73dSDamien Bergamini 	}
225ceaec73dSDamien Bergamini 	return ENXIO;
226ceaec73dSDamien Bergamini }
227ceaec73dSDamien Bergamini 
228ceaec73dSDamien Bergamini /* Base Address Register */
229ceaec73dSDamien Bergamini #define IWI_PCI_BAR0	0x10
230ceaec73dSDamien Bergamini 
231ceaec73dSDamien Bergamini static int
232ceaec73dSDamien Bergamini iwi_attach(device_t dev)
233ceaec73dSDamien Bergamini {
234ceaec73dSDamien Bergamini 	struct iwi_softc *sc = device_get_softc(dev);
235fc74a9f9SBrooks Davis 	struct ifnet *ifp;
236ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
237ceaec73dSDamien Bergamini 	uint16_t val;
238ceaec73dSDamien Bergamini 	int error, i;
239ceaec73dSDamien Bergamini 
240ceaec73dSDamien Bergamini 	sc->sc_dev = dev;
241ceaec73dSDamien Bergamini 
242ceaec73dSDamien Bergamini 	mtx_init(&sc->sc_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK,
243ceaec73dSDamien Bergamini 	    MTX_DEF | MTX_RECURSE);
244ceaec73dSDamien Bergamini 
24528a38073SDamien Bergamini 	sc->sc_unr = new_unrhdr(0, IWI_MAX_IBSSNODE, &sc->sc_mtx);
24628a38073SDamien Bergamini 
247ceaec73dSDamien Bergamini 	if (pci_get_powerstate(dev) != PCI_POWERSTATE_D0) {
248ceaec73dSDamien Bergamini 		device_printf(dev, "chip is in D%d power mode "
249ceaec73dSDamien Bergamini 		    "-- setting to D0\n", pci_get_powerstate(dev));
250ceaec73dSDamien Bergamini 		pci_set_powerstate(dev, PCI_POWERSTATE_D0);
251ceaec73dSDamien Bergamini 	}
252ceaec73dSDamien Bergamini 
253acea4241SDamien Bergamini 	pci_write_config(dev, 0x41, 0, 1);
254acea4241SDamien Bergamini 
255ceaec73dSDamien Bergamini 	/* enable bus-mastering */
256ceaec73dSDamien Bergamini 	pci_enable_busmaster(dev);
257ceaec73dSDamien Bergamini 
258ceaec73dSDamien Bergamini 	sc->mem_rid = IWI_PCI_BAR0;
259ceaec73dSDamien Bergamini 	sc->mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->mem_rid,
260ceaec73dSDamien Bergamini 	    RF_ACTIVE);
261ceaec73dSDamien Bergamini 	if (sc->mem == NULL) {
262ceaec73dSDamien Bergamini 		device_printf(dev, "could not allocate memory resource\n");
263ceaec73dSDamien Bergamini 		goto fail;
264ceaec73dSDamien Bergamini 	}
265ceaec73dSDamien Bergamini 
266ceaec73dSDamien Bergamini 	sc->sc_st = rman_get_bustag(sc->mem);
267ceaec73dSDamien Bergamini 	sc->sc_sh = rman_get_bushandle(sc->mem);
268ceaec73dSDamien Bergamini 
269ceaec73dSDamien Bergamini 	sc->irq_rid = 0;
270ceaec73dSDamien Bergamini 	sc->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->irq_rid,
271ceaec73dSDamien Bergamini 	    RF_ACTIVE | RF_SHAREABLE);
272ceaec73dSDamien Bergamini 	if (sc->irq == NULL) {
273ceaec73dSDamien Bergamini 		device_printf(dev, "could not allocate interrupt resource\n");
274ceaec73dSDamien Bergamini 		goto fail;
275ceaec73dSDamien Bergamini 	}
276ceaec73dSDamien Bergamini 
277ceaec73dSDamien Bergamini 	if (iwi_reset(sc) != 0) {
278ceaec73dSDamien Bergamini 		device_printf(dev, "could not reset adapter\n");
279ceaec73dSDamien Bergamini 		goto fail;
280ceaec73dSDamien Bergamini 	}
281ceaec73dSDamien Bergamini 
282ceaec73dSDamien Bergamini 	/*
283ceaec73dSDamien Bergamini 	 * Allocate rings.
284ceaec73dSDamien Bergamini 	 */
285ceaec73dSDamien Bergamini 	if (iwi_alloc_cmd_ring(sc, &sc->cmdq, IWI_CMD_RING_COUNT) != 0) {
286ceaec73dSDamien Bergamini 		device_printf(dev, "could not allocate Cmd ring\n");
287ceaec73dSDamien Bergamini 		goto fail;
288ceaec73dSDamien Bergamini 	}
289ceaec73dSDamien Bergamini 
290ec01dc2bSDamien Bergamini 	error = iwi_alloc_tx_ring(sc, &sc->txq[0], IWI_TX_RING_COUNT,
291ec01dc2bSDamien Bergamini 	    IWI_CSR_TX1_RIDX, IWI_CSR_TX1_WIDX);
292ec01dc2bSDamien Bergamini 	if (error != 0) {
293ec01dc2bSDamien Bergamini 		device_printf(dev, "could not allocate Tx ring 1\n");
294ec01dc2bSDamien Bergamini 		goto fail;
295ec01dc2bSDamien Bergamini 	}
296ec01dc2bSDamien Bergamini 
297ec01dc2bSDamien Bergamini 	error = iwi_alloc_tx_ring(sc, &sc->txq[1], IWI_TX_RING_COUNT,
298ec01dc2bSDamien Bergamini 	    IWI_CSR_TX2_RIDX, IWI_CSR_TX2_WIDX);
299ec01dc2bSDamien Bergamini 	if (error != 0) {
300ec01dc2bSDamien Bergamini 		device_printf(dev, "could not allocate Tx ring 2\n");
301ec01dc2bSDamien Bergamini 		goto fail;
302ec01dc2bSDamien Bergamini 	}
303ec01dc2bSDamien Bergamini 
304ec01dc2bSDamien Bergamini 	error = iwi_alloc_tx_ring(sc, &sc->txq[2], IWI_TX_RING_COUNT,
305ec01dc2bSDamien Bergamini 	    IWI_CSR_TX3_RIDX, IWI_CSR_TX3_WIDX);
306ec01dc2bSDamien Bergamini 	if (error != 0) {
307ec01dc2bSDamien Bergamini 		device_printf(dev, "could not allocate Tx ring 3\n");
308ec01dc2bSDamien Bergamini 		goto fail;
309ec01dc2bSDamien Bergamini 	}
310ec01dc2bSDamien Bergamini 
311ec01dc2bSDamien Bergamini 	error = iwi_alloc_tx_ring(sc, &sc->txq[3], IWI_TX_RING_COUNT,
312ec01dc2bSDamien Bergamini 	    IWI_CSR_TX4_RIDX, IWI_CSR_TX4_WIDX);
313ec01dc2bSDamien Bergamini 	if (error != 0) {
314ec01dc2bSDamien Bergamini 		device_printf(dev, "could not allocate Tx ring 4\n");
315ceaec73dSDamien Bergamini 		goto fail;
316ceaec73dSDamien Bergamini 	}
317ceaec73dSDamien Bergamini 
318ceaec73dSDamien Bergamini 	if (iwi_alloc_rx_ring(sc, &sc->rxq, IWI_RX_RING_COUNT) != 0) {
319ceaec73dSDamien Bergamini 		device_printf(dev, "could not allocate Rx ring\n");
320ceaec73dSDamien Bergamini 		goto fail;
321ceaec73dSDamien Bergamini 	}
322ceaec73dSDamien Bergamini 
323fc74a9f9SBrooks Davis 	ifp = sc->sc_ifp = if_alloc(IFT_ETHER);
324fc74a9f9SBrooks Davis 	if (ifp == NULL) {
325fc74a9f9SBrooks Davis 		device_printf(dev, "can not if_alloc()\n");
326fc74a9f9SBrooks Davis 		goto fail;
327fc74a9f9SBrooks Davis 	}
328ceaec73dSDamien Bergamini 	ifp->if_softc = sc;
329ceaec73dSDamien Bergamini 	if_initname(ifp, device_get_name(dev), device_get_unit(dev));
330ceaec73dSDamien Bergamini 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
331ceaec73dSDamien Bergamini 	ifp->if_init = iwi_init;
332ceaec73dSDamien Bergamini 	ifp->if_ioctl = iwi_ioctl;
333ceaec73dSDamien Bergamini 	ifp->if_start = iwi_start;
334ceaec73dSDamien Bergamini 	ifp->if_watchdog = iwi_watchdog;
335ceaec73dSDamien Bergamini 	IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN);
336ceaec73dSDamien Bergamini 	ifp->if_snd.ifq_drv_maxlen = IFQ_MAXLEN;
337ceaec73dSDamien Bergamini 	IFQ_SET_READY(&ifp->if_snd);
338ceaec73dSDamien Bergamini 
339ceaec73dSDamien Bergamini 	ic->ic_ifp = ifp;
340ec01dc2bSDamien Bergamini 	ic->ic_wme.wme_update = iwi_wme_update;
341ceaec73dSDamien Bergamini 	ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */
342ceaec73dSDamien Bergamini 	ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */
343ceaec73dSDamien Bergamini 	ic->ic_state = IEEE80211_S_INIT;
344ceaec73dSDamien Bergamini 
345ceaec73dSDamien Bergamini 	/* set device capabilities */
346ec01dc2bSDamien Bergamini 	ic->ic_caps =
3470b74a285SDamien Bergamini 	    IEEE80211_C_IBSS |		/* IBSS mode supported */
348ec01dc2bSDamien Bergamini 	    IEEE80211_C_MONITOR |	/* monitor mode supported */
349ec01dc2bSDamien Bergamini 	    IEEE80211_C_TXPMGT |	/* tx power management */
350ec01dc2bSDamien Bergamini 	    IEEE80211_C_SHPREAMBLE |	/* short preamble supported */
351ec01dc2bSDamien Bergamini 	    IEEE80211_C_WPA |		/* 802.11i */
352ec01dc2bSDamien Bergamini 	    IEEE80211_C_WME;		/* 802.11e */
353ceaec73dSDamien Bergamini 
354ceaec73dSDamien Bergamini 	/* read MAC address from EEPROM */
355ceaec73dSDamien Bergamini 	val = iwi_read_prom_word(sc, IWI_EEPROM_MAC + 0);
35681e6343cSDamien Bergamini 	ic->ic_myaddr[0] = val & 0xff;
35781e6343cSDamien Bergamini 	ic->ic_myaddr[1] = val >> 8;
358ceaec73dSDamien Bergamini 	val = iwi_read_prom_word(sc, IWI_EEPROM_MAC + 1);
35981e6343cSDamien Bergamini 	ic->ic_myaddr[2] = val & 0xff;
36081e6343cSDamien Bergamini 	ic->ic_myaddr[3] = val >> 8;
361ceaec73dSDamien Bergamini 	val = iwi_read_prom_word(sc, IWI_EEPROM_MAC + 2);
36281e6343cSDamien Bergamini 	ic->ic_myaddr[4] = val & 0xff;
36381e6343cSDamien Bergamini 	ic->ic_myaddr[5] = val >> 8;
364ceaec73dSDamien Bergamini 
365ceaec73dSDamien Bergamini 	if (pci_get_device(dev) >= 0x4223) {
366ceaec73dSDamien Bergamini 		/* set supported .11a rates (2915ABG only) */
367ceaec73dSDamien Bergamini 		ic->ic_sup_rates[IEEE80211_MODE_11A] = iwi_rateset_11a;
368ceaec73dSDamien Bergamini 
369ceaec73dSDamien Bergamini 		/* set supported .11a channels */
370ceaec73dSDamien Bergamini 		for (i = 36; i <= 64; i += 4) {
371ceaec73dSDamien Bergamini 			ic->ic_channels[i].ic_freq =
372ceaec73dSDamien Bergamini 			    ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
373ceaec73dSDamien Bergamini 			ic->ic_channels[i].ic_flags = IEEE80211_CHAN_A;
374ceaec73dSDamien Bergamini 		}
375ceaec73dSDamien Bergamini 		for (i = 149; i <= 165; i += 4) {
376ceaec73dSDamien Bergamini 			ic->ic_channels[i].ic_freq =
377ceaec73dSDamien Bergamini 			    ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
378ceaec73dSDamien Bergamini 			ic->ic_channels[i].ic_flags = IEEE80211_CHAN_A;
379ceaec73dSDamien Bergamini 		}
380ceaec73dSDamien Bergamini 	}
381ceaec73dSDamien Bergamini 
382ceaec73dSDamien Bergamini 	/* set supported .11b and .11g rates */
383ceaec73dSDamien Bergamini 	ic->ic_sup_rates[IEEE80211_MODE_11B] = iwi_rateset_11b;
384ceaec73dSDamien Bergamini 	ic->ic_sup_rates[IEEE80211_MODE_11G] = iwi_rateset_11g;
385ceaec73dSDamien Bergamini 
386ceaec73dSDamien Bergamini 	/* set supported .11b and .11g channels (1 through 14) */
387ceaec73dSDamien Bergamini 	for (i = 1; i <= 14; i++) {
388ceaec73dSDamien Bergamini 		ic->ic_channels[i].ic_freq =
389ceaec73dSDamien Bergamini 		    ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ);
390ceaec73dSDamien Bergamini 		ic->ic_channels[i].ic_flags =
391ceaec73dSDamien Bergamini 		    IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM |
392ceaec73dSDamien Bergamini 		    IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ;
393ceaec73dSDamien Bergamini 	}
394ceaec73dSDamien Bergamini 
395ceaec73dSDamien Bergamini 	ieee80211_ifattach(ic);
39628a38073SDamien Bergamini 	/* override default methods */
39728a38073SDamien Bergamini 	ic->ic_node_alloc = iwi_node_alloc;
39828a38073SDamien Bergamini 	sc->sc_node_free = ic->ic_node_free;
39928a38073SDamien Bergamini 	ic->ic_node_free = iwi_node_free;
400ceaec73dSDamien Bergamini 	/* override state transition machine */
401ceaec73dSDamien Bergamini 	sc->sc_newstate = ic->ic_newstate;
402ceaec73dSDamien Bergamini 	ic->ic_newstate = iwi_newstate;
403ceaec73dSDamien Bergamini 	ieee80211_media_init(ic, iwi_media_change, iwi_media_status);
404ceaec73dSDamien Bergamini 
405ceaec73dSDamien Bergamini 	bpfattach2(ifp, DLT_IEEE802_11_RADIO,
406ceaec73dSDamien Bergamini 	    sizeof (struct ieee80211_frame) + 64, &sc->sc_drvbpf);
407ceaec73dSDamien Bergamini 
408ceaec73dSDamien Bergamini 	sc->sc_rxtap_len = sizeof sc->sc_rxtapu;
409ceaec73dSDamien Bergamini 	sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len);
410ceaec73dSDamien Bergamini 	sc->sc_rxtap.wr_ihdr.it_present = htole32(IWI_RX_RADIOTAP_PRESENT);
411ceaec73dSDamien Bergamini 
412ceaec73dSDamien Bergamini 	sc->sc_txtap_len = sizeof sc->sc_txtapu;
413ceaec73dSDamien Bergamini 	sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len);
414ceaec73dSDamien Bergamini 	sc->sc_txtap.wt_ihdr.it_present = htole32(IWI_TX_RADIOTAP_PRESENT);
415ceaec73dSDamien Bergamini 
416ceaec73dSDamien Bergamini 	/*
417ceaec73dSDamien Bergamini 	 * Add a few sysctl knobs.
418ceaec73dSDamien Bergamini 	 */
419ceaec73dSDamien Bergamini 	sc->dwelltime = 100;
420ceaec73dSDamien Bergamini 	sc->bluetooth = 1;
421acea4241SDamien Bergamini 	sc->antenna = 0;
422ceaec73dSDamien Bergamini 
423ceaec73dSDamien Bergamini 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
424ceaec73dSDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "radio",
425ceaec73dSDamien Bergamini 	    CTLTYPE_INT | CTLFLAG_RD, sc, 0, iwi_sysctl_radio, "I",
426ceaec73dSDamien Bergamini 	    "radio transmitter switch state (0=off, 1=on)");
427ceaec73dSDamien Bergamini 
428ceaec73dSDamien Bergamini 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
429ceaec73dSDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "stats",
430ceaec73dSDamien Bergamini 	    CTLTYPE_OPAQUE | CTLFLAG_RD, sc, 0, iwi_sysctl_stats, "S",
431ceaec73dSDamien Bergamini 	    "statistics");
432ceaec73dSDamien Bergamini 
433ceaec73dSDamien Bergamini 	SYSCTL_ADD_INT(device_get_sysctl_ctx(dev),
434ceaec73dSDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "dwell",
435ceaec73dSDamien Bergamini 	    CTLFLAG_RW, &sc->dwelltime, 0,
436ceaec73dSDamien Bergamini 	    "channel dwell time (ms) for AP/station scanning");
437ceaec73dSDamien Bergamini 
438ceaec73dSDamien Bergamini 	SYSCTL_ADD_INT(device_get_sysctl_ctx(dev),
439ceaec73dSDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "bluetooth",
440ceaec73dSDamien Bergamini 	    CTLFLAG_RW, &sc->bluetooth, 0, "bluetooth coexistence");
441ceaec73dSDamien Bergamini 
442acea4241SDamien Bergamini 	SYSCTL_ADD_INT(device_get_sysctl_ctx(dev),
443acea4241SDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "antenna",
444acea4241SDamien Bergamini 	    CTLFLAG_RW, &sc->antenna, 0, "antenna (0=auto)");
445acea4241SDamien Bergamini 
446ceaec73dSDamien Bergamini 	/*
447ceaec73dSDamien Bergamini 	 * Hook our interrupt after all initialization is complete.
448ceaec73dSDamien Bergamini 	 */
449ceaec73dSDamien Bergamini 	error = bus_setup_intr(dev, sc->irq, INTR_TYPE_NET | INTR_MPSAFE,
450ceaec73dSDamien Bergamini 	    iwi_intr, sc, &sc->sc_ih);
451ceaec73dSDamien Bergamini 	if (error != 0) {
452ceaec73dSDamien Bergamini 		device_printf(dev, "could not set up interrupt\n");
453ceaec73dSDamien Bergamini 		goto fail;
454ceaec73dSDamien Bergamini 	}
455ceaec73dSDamien Bergamini 
456ceaec73dSDamien Bergamini 	if (bootverbose)
457ceaec73dSDamien Bergamini 		ieee80211_announce(ic);
458ceaec73dSDamien Bergamini 
459ceaec73dSDamien Bergamini 	return 0;
460ceaec73dSDamien Bergamini 
461ceaec73dSDamien Bergamini fail:	iwi_detach(dev);
462ceaec73dSDamien Bergamini 	return ENXIO;
463ceaec73dSDamien Bergamini }
464ceaec73dSDamien Bergamini 
465ceaec73dSDamien Bergamini static int
466ceaec73dSDamien Bergamini iwi_detach(device_t dev)
467ceaec73dSDamien Bergamini {
468ceaec73dSDamien Bergamini 	struct iwi_softc *sc = device_get_softc(dev);
469ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
470ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
471ceaec73dSDamien Bergamini 
472ceaec73dSDamien Bergamini 	iwi_stop(sc);
473ceaec73dSDamien Bergamini 
4740b74a285SDamien Bergamini 	if (ifp != NULL) {
475ceaec73dSDamien Bergamini 		bpfdetach(ifp);
476ceaec73dSDamien Bergamini 		ieee80211_ifdetach(ic);
4770b74a285SDamien Bergamini 	}
478ceaec73dSDamien Bergamini 
479ceaec73dSDamien Bergamini 	iwi_free_cmd_ring(sc, &sc->cmdq);
480ec01dc2bSDamien Bergamini 	iwi_free_tx_ring(sc, &sc->txq[0]);
481ec01dc2bSDamien Bergamini 	iwi_free_tx_ring(sc, &sc->txq[1]);
482ec01dc2bSDamien Bergamini 	iwi_free_tx_ring(sc, &sc->txq[2]);
483ec01dc2bSDamien Bergamini 	iwi_free_tx_ring(sc, &sc->txq[3]);
484ceaec73dSDamien Bergamini 	iwi_free_rx_ring(sc, &sc->rxq);
485ceaec73dSDamien Bergamini 
486ceaec73dSDamien Bergamini 	if (sc->irq != NULL) {
487ceaec73dSDamien Bergamini 		bus_teardown_intr(dev, sc->irq, sc->sc_ih);
488ceaec73dSDamien Bergamini 		bus_release_resource(dev, SYS_RES_IRQ, sc->irq_rid, sc->irq);
489ceaec73dSDamien Bergamini 	}
490ceaec73dSDamien Bergamini 
491ceaec73dSDamien Bergamini 	if (sc->mem != NULL)
492ceaec73dSDamien Bergamini 		bus_release_resource(dev, SYS_RES_MEMORY, sc->mem_rid, sc->mem);
493ceaec73dSDamien Bergamini 
494ad4f426eSWarner Losh 	if (ifp != NULL)
495ad4f426eSWarner Losh 		if_free(ifp);
4967e47fb02SDamien Bergamini 
49728a38073SDamien Bergamini 	if (sc->sc_unr != NULL)
49828a38073SDamien Bergamini 		delete_unrhdr(sc->sc_unr);
49928a38073SDamien Bergamini 
500ceaec73dSDamien Bergamini 	mtx_destroy(&sc->sc_mtx);
501ceaec73dSDamien Bergamini 
502ceaec73dSDamien Bergamini 	return 0;
503ceaec73dSDamien Bergamini }
504ceaec73dSDamien Bergamini 
505ceaec73dSDamien Bergamini static void
506ceaec73dSDamien Bergamini iwi_dma_map_addr(void *arg, bus_dma_segment_t *segs, int nseg, int error)
507ceaec73dSDamien Bergamini {
508ceaec73dSDamien Bergamini 	if (error != 0)
509ceaec73dSDamien Bergamini 		return;
510ceaec73dSDamien Bergamini 
511ceaec73dSDamien Bergamini 	KASSERT(nseg == 1, ("too many DMA segments, %d should be 1", nseg));
512ceaec73dSDamien Bergamini 
513ceaec73dSDamien Bergamini 	*(bus_addr_t *)arg = segs[0].ds_addr;
514ceaec73dSDamien Bergamini }
515ceaec73dSDamien Bergamini 
516ceaec73dSDamien Bergamini static int
517ceaec73dSDamien Bergamini iwi_alloc_cmd_ring(struct iwi_softc *sc, struct iwi_cmd_ring *ring, int count)
518ceaec73dSDamien Bergamini {
519ceaec73dSDamien Bergamini 	int error;
520ceaec73dSDamien Bergamini 
521ceaec73dSDamien Bergamini 	ring->count = count;
522ceaec73dSDamien Bergamini 	ring->queued = 0;
523ceaec73dSDamien Bergamini 	ring->cur = ring->next = 0;
524ceaec73dSDamien Bergamini 
525ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
526ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, count * IWI_CMD_DESC_SIZE, 1,
527ceaec73dSDamien Bergamini 	    count * IWI_CMD_DESC_SIZE, 0, NULL, NULL, &ring->desc_dmat);
528ceaec73dSDamien Bergamini 	if (error != 0) {
529ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create desc DMA tag\n");
530ceaec73dSDamien Bergamini 		goto fail;
531ceaec73dSDamien Bergamini 	}
532ceaec73dSDamien Bergamini 
533ceaec73dSDamien Bergamini 	error = bus_dmamem_alloc(ring->desc_dmat, (void **)&ring->desc,
534ceaec73dSDamien Bergamini 	    BUS_DMA_NOWAIT | BUS_DMA_ZERO, &ring->desc_map);
535ceaec73dSDamien Bergamini 	if (error != 0) {
536ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate DMA memory\n");
537ceaec73dSDamien Bergamini 		goto fail;
538ceaec73dSDamien Bergamini 	}
539ceaec73dSDamien Bergamini 
540ceaec73dSDamien Bergamini 	error = bus_dmamap_load(ring->desc_dmat, ring->desc_map, ring->desc,
541ceaec73dSDamien Bergamini 	    count * IWI_CMD_DESC_SIZE, iwi_dma_map_addr, &ring->physaddr, 0);
542ceaec73dSDamien Bergamini 	if (error != 0) {
543ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load desc DMA map\n");
544ceaec73dSDamien Bergamini 		goto fail;
545ceaec73dSDamien Bergamini 	}
546ceaec73dSDamien Bergamini 
547ceaec73dSDamien Bergamini 	return 0;
548ceaec73dSDamien Bergamini 
549ceaec73dSDamien Bergamini fail:	iwi_free_cmd_ring(sc, ring);
550ceaec73dSDamien Bergamini 	return error;
551ceaec73dSDamien Bergamini }
552ceaec73dSDamien Bergamini 
553ceaec73dSDamien Bergamini static void
554ceaec73dSDamien Bergamini iwi_reset_cmd_ring(struct iwi_softc *sc, struct iwi_cmd_ring *ring)
555ceaec73dSDamien Bergamini {
556ceaec73dSDamien Bergamini 	ring->queued = 0;
557ceaec73dSDamien Bergamini 	ring->cur = ring->next = 0;
558ceaec73dSDamien Bergamini }
559ceaec73dSDamien Bergamini 
560ceaec73dSDamien Bergamini static void
561ceaec73dSDamien Bergamini iwi_free_cmd_ring(struct iwi_softc *sc, struct iwi_cmd_ring *ring)
562ceaec73dSDamien Bergamini {
563ceaec73dSDamien Bergamini 	if (ring->desc != NULL) {
564ceaec73dSDamien Bergamini 		bus_dmamap_sync(ring->desc_dmat, ring->desc_map,
565ceaec73dSDamien Bergamini 		    BUS_DMASYNC_POSTWRITE);
566ceaec73dSDamien Bergamini 		bus_dmamap_unload(ring->desc_dmat, ring->desc_map);
567ceaec73dSDamien Bergamini 		bus_dmamem_free(ring->desc_dmat, ring->desc, ring->desc_map);
568ceaec73dSDamien Bergamini 	}
569ceaec73dSDamien Bergamini 
570ceaec73dSDamien Bergamini 	if (ring->desc_dmat != NULL)
571ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(ring->desc_dmat);
572ceaec73dSDamien Bergamini }
573ceaec73dSDamien Bergamini 
574ceaec73dSDamien Bergamini static int
575ec01dc2bSDamien Bergamini iwi_alloc_tx_ring(struct iwi_softc *sc, struct iwi_tx_ring *ring, int count,
576ec01dc2bSDamien Bergamini     bus_addr_t csr_ridx, bus_addr_t csr_widx)
577ceaec73dSDamien Bergamini {
578ceaec73dSDamien Bergamini 	int i, error;
579ceaec73dSDamien Bergamini 
580ceaec73dSDamien Bergamini 	ring->count = count;
581ceaec73dSDamien Bergamini 	ring->queued = 0;
582ceaec73dSDamien Bergamini 	ring->cur = ring->next = 0;
583ec01dc2bSDamien Bergamini 	ring->csr_ridx = csr_ridx;
584ec01dc2bSDamien Bergamini 	ring->csr_widx = csr_widx;
585ceaec73dSDamien Bergamini 
586ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
587ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, count * IWI_TX_DESC_SIZE, 1,
588ceaec73dSDamien Bergamini 	    count * IWI_TX_DESC_SIZE, 0, NULL, NULL, &ring->desc_dmat);
589ceaec73dSDamien Bergamini 	if (error != 0) {
590ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create desc DMA tag\n");
591ceaec73dSDamien Bergamini 		goto fail;
592ceaec73dSDamien Bergamini 	}
593ceaec73dSDamien Bergamini 
594ceaec73dSDamien Bergamini 	error = bus_dmamem_alloc(ring->desc_dmat, (void **)&ring->desc,
595ceaec73dSDamien Bergamini 	    BUS_DMA_NOWAIT | BUS_DMA_ZERO, &ring->desc_map);
596ceaec73dSDamien Bergamini 	if (error != 0) {
597ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate DMA memory\n");
598ceaec73dSDamien Bergamini 		goto fail;
599ceaec73dSDamien Bergamini 	}
600ceaec73dSDamien Bergamini 
601ceaec73dSDamien Bergamini 	error = bus_dmamap_load(ring->desc_dmat, ring->desc_map, ring->desc,
602ceaec73dSDamien Bergamini 	    count * IWI_TX_DESC_SIZE, iwi_dma_map_addr, &ring->physaddr, 0);
603ceaec73dSDamien Bergamini 	if (error != 0) {
604ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load desc DMA map\n");
605ceaec73dSDamien Bergamini 		goto fail;
606ceaec73dSDamien Bergamini 	}
607ceaec73dSDamien Bergamini 
608ceaec73dSDamien Bergamini 	ring->data = malloc(count * sizeof (struct iwi_tx_data), M_DEVBUF,
609ceaec73dSDamien Bergamini 	    M_NOWAIT | M_ZERO);
610ceaec73dSDamien Bergamini 	if (ring->data == NULL) {
611ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate soft data\n");
612ceaec73dSDamien Bergamini 		error = ENOMEM;
613ceaec73dSDamien Bergamini 		goto fail;
614ceaec73dSDamien Bergamini 	}
615ceaec73dSDamien Bergamini 
616ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT,
617ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, 1, MCLBYTES, 0, NULL,
618ceaec73dSDamien Bergamini 	    NULL, &ring->data_dmat);
619ceaec73dSDamien Bergamini 	if (error != 0) {
620ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create data DMA tag\n");
621ceaec73dSDamien Bergamini 		goto fail;
622ceaec73dSDamien Bergamini 	}
623ceaec73dSDamien Bergamini 
624ceaec73dSDamien Bergamini 	for (i = 0; i < count; i++) {
625ceaec73dSDamien Bergamini 		error = bus_dmamap_create(ring->data_dmat, 0,
626ceaec73dSDamien Bergamini 		    &ring->data[i].map);
627ceaec73dSDamien Bergamini 		if (error != 0) {
628ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev, "could not create DMA map\n");
629ceaec73dSDamien Bergamini 			goto fail;
630ceaec73dSDamien Bergamini 		}
631ceaec73dSDamien Bergamini 	}
632ceaec73dSDamien Bergamini 
633ceaec73dSDamien Bergamini 	return 0;
634ceaec73dSDamien Bergamini 
635ceaec73dSDamien Bergamini fail:	iwi_free_tx_ring(sc, ring);
636ceaec73dSDamien Bergamini 	return error;
637ceaec73dSDamien Bergamini }
638ceaec73dSDamien Bergamini 
639ceaec73dSDamien Bergamini static void
640ceaec73dSDamien Bergamini iwi_reset_tx_ring(struct iwi_softc *sc, struct iwi_tx_ring *ring)
641ceaec73dSDamien Bergamini {
642ceaec73dSDamien Bergamini 	struct iwi_tx_data *data;
643ceaec73dSDamien Bergamini 	int i;
644ceaec73dSDamien Bergamini 
645ceaec73dSDamien Bergamini 	for (i = 0; i < ring->count; i++) {
646ceaec73dSDamien Bergamini 		data = &ring->data[i];
647ceaec73dSDamien Bergamini 
648ceaec73dSDamien Bergamini 		if (data->m != NULL) {
649ceaec73dSDamien Bergamini 			bus_dmamap_sync(ring->data_dmat, data->map,
650ceaec73dSDamien Bergamini 			    BUS_DMASYNC_POSTWRITE);
651ceaec73dSDamien Bergamini 			bus_dmamap_unload(ring->data_dmat, data->map);
652ceaec73dSDamien Bergamini 			m_freem(data->m);
653ceaec73dSDamien Bergamini 			data->m = NULL;
654ceaec73dSDamien Bergamini 		}
655ceaec73dSDamien Bergamini 
656ceaec73dSDamien Bergamini 		if (data->ni != NULL) {
657ceaec73dSDamien Bergamini 			ieee80211_free_node(data->ni);
658ceaec73dSDamien Bergamini 			data->ni = NULL;
659ceaec73dSDamien Bergamini 		}
660ceaec73dSDamien Bergamini 	}
661ceaec73dSDamien Bergamini 
662ceaec73dSDamien Bergamini 	ring->queued = 0;
663ceaec73dSDamien Bergamini 	ring->cur = ring->next = 0;
664ceaec73dSDamien Bergamini }
665ceaec73dSDamien Bergamini 
666ceaec73dSDamien Bergamini static void
667ceaec73dSDamien Bergamini iwi_free_tx_ring(struct iwi_softc *sc, struct iwi_tx_ring *ring)
668ceaec73dSDamien Bergamini {
669ceaec73dSDamien Bergamini 	struct iwi_tx_data *data;
670ceaec73dSDamien Bergamini 	int i;
671ceaec73dSDamien Bergamini 
672ceaec73dSDamien Bergamini 	if (ring->desc != NULL) {
673ceaec73dSDamien Bergamini 		bus_dmamap_sync(ring->desc_dmat, ring->desc_map,
674ceaec73dSDamien Bergamini 		    BUS_DMASYNC_POSTWRITE);
675ceaec73dSDamien Bergamini 		bus_dmamap_unload(ring->desc_dmat, ring->desc_map);
676ceaec73dSDamien Bergamini 		bus_dmamem_free(ring->desc_dmat, ring->desc, ring->desc_map);
677ceaec73dSDamien Bergamini 	}
678ceaec73dSDamien Bergamini 
679ceaec73dSDamien Bergamini 	if (ring->desc_dmat != NULL)
680ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(ring->desc_dmat);
681ceaec73dSDamien Bergamini 
682ceaec73dSDamien Bergamini 	if (ring->data != NULL) {
683ceaec73dSDamien Bergamini 		for (i = 0; i < ring->count; i++) {
684ceaec73dSDamien Bergamini 			data = &ring->data[i];
685ceaec73dSDamien Bergamini 
686ceaec73dSDamien Bergamini 			if (data->m != NULL) {
687ceaec73dSDamien Bergamini 				bus_dmamap_sync(ring->data_dmat, data->map,
688ceaec73dSDamien Bergamini 				    BUS_DMASYNC_POSTWRITE);
689ceaec73dSDamien Bergamini 				bus_dmamap_unload(ring->data_dmat, data->map);
690ceaec73dSDamien Bergamini 				m_freem(data->m);
691ceaec73dSDamien Bergamini 			}
692ceaec73dSDamien Bergamini 
693ceaec73dSDamien Bergamini 			if (data->ni != NULL)
694ceaec73dSDamien Bergamini 				ieee80211_free_node(data->ni);
695ceaec73dSDamien Bergamini 
696ceaec73dSDamien Bergamini 			if (data->map != NULL)
697ceaec73dSDamien Bergamini 				bus_dmamap_destroy(ring->data_dmat, data->map);
698ceaec73dSDamien Bergamini 		}
699ceaec73dSDamien Bergamini 
700ceaec73dSDamien Bergamini 		free(ring->data, M_DEVBUF);
701ceaec73dSDamien Bergamini 	}
702ceaec73dSDamien Bergamini 
703ceaec73dSDamien Bergamini 	if (ring->data_dmat != NULL)
704ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(ring->data_dmat);
705ceaec73dSDamien Bergamini }
706ceaec73dSDamien Bergamini 
707ceaec73dSDamien Bergamini static int
708ceaec73dSDamien Bergamini iwi_alloc_rx_ring(struct iwi_softc *sc, struct iwi_rx_ring *ring, int count)
709ceaec73dSDamien Bergamini {
710ceaec73dSDamien Bergamini 	struct iwi_rx_data *data;
711ceaec73dSDamien Bergamini 	int i, error;
712ceaec73dSDamien Bergamini 
713ceaec73dSDamien Bergamini 	ring->count = count;
714ceaec73dSDamien Bergamini 	ring->cur = 0;
715ceaec73dSDamien Bergamini 
716ceaec73dSDamien Bergamini 	ring->data = malloc(count * sizeof (struct iwi_rx_data), M_DEVBUF,
717ceaec73dSDamien Bergamini 	    M_NOWAIT | M_ZERO);
718ceaec73dSDamien Bergamini 	if (ring->data == NULL) {
719ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate soft data\n");
720ceaec73dSDamien Bergamini 		error = ENOMEM;
721ceaec73dSDamien Bergamini 		goto fail;
722ceaec73dSDamien Bergamini 	}
723ceaec73dSDamien Bergamini 
724ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT,
725ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, 1, MCLBYTES, 0, NULL,
726ceaec73dSDamien Bergamini 	    NULL, &ring->data_dmat);
727ceaec73dSDamien Bergamini 	if (error != 0) {
728ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create data DMA tag\n");
729ceaec73dSDamien Bergamini 		goto fail;
730ceaec73dSDamien Bergamini 	}
731ceaec73dSDamien Bergamini 
732ceaec73dSDamien Bergamini 	for (i = 0; i < count; i++) {
733ceaec73dSDamien Bergamini 		data = &ring->data[i];
734ceaec73dSDamien Bergamini 
735ceaec73dSDamien Bergamini 		error = bus_dmamap_create(ring->data_dmat, 0, &data->map);
736ceaec73dSDamien Bergamini 		if (error != 0) {
737ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev, "could not create DMA map\n");
738ceaec73dSDamien Bergamini 			goto fail;
739ceaec73dSDamien Bergamini 		}
740ceaec73dSDamien Bergamini 
741ceaec73dSDamien Bergamini 		data->m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR);
742ceaec73dSDamien Bergamini 		if (data->m == NULL) {
743ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
744ceaec73dSDamien Bergamini 			    "could not allocate rx mbuf\n");
745ceaec73dSDamien Bergamini 			error = ENOMEM;
746ceaec73dSDamien Bergamini 			goto fail;
747ceaec73dSDamien Bergamini 		}
748ceaec73dSDamien Bergamini 
749ceaec73dSDamien Bergamini 		error = bus_dmamap_load(ring->data_dmat, data->map,
750ceaec73dSDamien Bergamini 		    mtod(data->m, void *), MCLBYTES, iwi_dma_map_addr,
751ceaec73dSDamien Bergamini 		    &data->physaddr, 0);
752ceaec73dSDamien Bergamini 		if (error != 0) {
753ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
754ceaec73dSDamien Bergamini 			    "could not load rx buf DMA map");
755ceaec73dSDamien Bergamini 			goto fail;
756ceaec73dSDamien Bergamini 		}
757ceaec73dSDamien Bergamini 
758ceaec73dSDamien Bergamini 		data->reg = IWI_CSR_RX_BASE + i * 4;
759ceaec73dSDamien Bergamini 	}
760ceaec73dSDamien Bergamini 
761ceaec73dSDamien Bergamini 	return 0;
762ceaec73dSDamien Bergamini 
763ceaec73dSDamien Bergamini fail:	iwi_free_rx_ring(sc, ring);
764ceaec73dSDamien Bergamini 	return error;
765ceaec73dSDamien Bergamini }
766ceaec73dSDamien Bergamini 
767ceaec73dSDamien Bergamini static void
768ceaec73dSDamien Bergamini iwi_reset_rx_ring(struct iwi_softc *sc, struct iwi_rx_ring *ring)
769ceaec73dSDamien Bergamini {
770ceaec73dSDamien Bergamini 	ring->cur = 0;
771ceaec73dSDamien Bergamini }
772ceaec73dSDamien Bergamini 
773ceaec73dSDamien Bergamini static void
774ceaec73dSDamien Bergamini iwi_free_rx_ring(struct iwi_softc *sc, struct iwi_rx_ring *ring)
775ceaec73dSDamien Bergamini {
776ceaec73dSDamien Bergamini 	struct iwi_rx_data *data;
777ceaec73dSDamien Bergamini 	int i;
778ceaec73dSDamien Bergamini 
779ceaec73dSDamien Bergamini 	if (ring->data != NULL) {
780ceaec73dSDamien Bergamini 		for (i = 0; i < ring->count; i++) {
781ceaec73dSDamien Bergamini 			data = &ring->data[i];
782ceaec73dSDamien Bergamini 
783ceaec73dSDamien Bergamini 			if (data->m != NULL) {
784ceaec73dSDamien Bergamini 				bus_dmamap_sync(ring->data_dmat, data->map,
785ceaec73dSDamien Bergamini 				    BUS_DMASYNC_POSTREAD);
786ceaec73dSDamien Bergamini 				bus_dmamap_unload(ring->data_dmat, data->map);
787ceaec73dSDamien Bergamini 				m_freem(data->m);
788ceaec73dSDamien Bergamini 			}
789ceaec73dSDamien Bergamini 
790ceaec73dSDamien Bergamini 			if (data->map != NULL)
791ceaec73dSDamien Bergamini 				bus_dmamap_destroy(ring->data_dmat, data->map);
792ceaec73dSDamien Bergamini 		}
793ceaec73dSDamien Bergamini 
794ceaec73dSDamien Bergamini 		free(ring->data, M_DEVBUF);
795ceaec73dSDamien Bergamini 	}
796ceaec73dSDamien Bergamini 
797ceaec73dSDamien Bergamini 	if (ring->data_dmat != NULL)
798ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(ring->data_dmat);
799ceaec73dSDamien Bergamini }
800ceaec73dSDamien Bergamini 
801ceaec73dSDamien Bergamini static int
802ceaec73dSDamien Bergamini iwi_shutdown(device_t dev)
803ceaec73dSDamien Bergamini {
804ceaec73dSDamien Bergamini 	struct iwi_softc *sc = device_get_softc(dev);
805ceaec73dSDamien Bergamini 
806ceaec73dSDamien Bergamini 	iwi_stop(sc);
807ceaec73dSDamien Bergamini 
808ceaec73dSDamien Bergamini 	return 0;
809ceaec73dSDamien Bergamini }
810ceaec73dSDamien Bergamini 
811ceaec73dSDamien Bergamini static int
812ceaec73dSDamien Bergamini iwi_suspend(device_t dev)
813ceaec73dSDamien Bergamini {
814ceaec73dSDamien Bergamini 	struct iwi_softc *sc = device_get_softc(dev);
815ceaec73dSDamien Bergamini 
816ceaec73dSDamien Bergamini 	iwi_stop(sc);
817ceaec73dSDamien Bergamini 
818ceaec73dSDamien Bergamini 	return 0;
819ceaec73dSDamien Bergamini }
820ceaec73dSDamien Bergamini 
821ceaec73dSDamien Bergamini static int
822ceaec73dSDamien Bergamini iwi_resume(device_t dev)
823ceaec73dSDamien Bergamini {
824ceaec73dSDamien Bergamini 	struct iwi_softc *sc = device_get_softc(dev);
825ceaec73dSDamien Bergamini 	struct ifnet *ifp = sc->sc_ic.ic_ifp;
826ceaec73dSDamien Bergamini 
827ceaec73dSDamien Bergamini 	IWI_LOCK(sc);
828ceaec73dSDamien Bergamini 
829acea4241SDamien Bergamini 	pci_write_config(dev, 0x41, 0, 1);
830acea4241SDamien Bergamini 
831ceaec73dSDamien Bergamini 	if (ifp->if_flags & IFF_UP) {
832ceaec73dSDamien Bergamini 		ifp->if_init(ifp->if_softc);
83313f4c340SRobert Watson 		if (ifp->if_drv_flags & IFF_DRV_RUNNING)
834ceaec73dSDamien Bergamini 			ifp->if_start(ifp);
835ceaec73dSDamien Bergamini 	}
836ceaec73dSDamien Bergamini 
837ceaec73dSDamien Bergamini 	IWI_UNLOCK(sc);
838ceaec73dSDamien Bergamini 
839ceaec73dSDamien Bergamini 	return 0;
840ceaec73dSDamien Bergamini }
841ceaec73dSDamien Bergamini 
84228a38073SDamien Bergamini static struct ieee80211_node *
84328a38073SDamien Bergamini iwi_node_alloc(struct ieee80211_node_table *nt)
84428a38073SDamien Bergamini {
84528a38073SDamien Bergamini 	struct iwi_node *in;
84628a38073SDamien Bergamini 
84728a38073SDamien Bergamini 	in = malloc(sizeof (struct iwi_node), M_80211_NODE, M_NOWAIT | M_ZERO);
84828a38073SDamien Bergamini 	if (in == NULL)
84928a38073SDamien Bergamini 		return NULL;
85028a38073SDamien Bergamini 
85128a38073SDamien Bergamini 	in->in_station = -1;
85228a38073SDamien Bergamini 
85328a38073SDamien Bergamini 	return &in->in_node;
85428a38073SDamien Bergamini }
85528a38073SDamien Bergamini 
85628a38073SDamien Bergamini static void
85728a38073SDamien Bergamini iwi_node_free(struct ieee80211_node *ni)
85828a38073SDamien Bergamini {
85928a38073SDamien Bergamini 	struct ieee80211com *ic = ni->ni_ic;
86028a38073SDamien Bergamini 	struct iwi_softc *sc = ic->ic_ifp->if_softc;
86128a38073SDamien Bergamini 	struct iwi_node *in = (struct iwi_node *)ni;
86228a38073SDamien Bergamini 
86328a38073SDamien Bergamini 	if (in->in_station != -1)
86428a38073SDamien Bergamini 		free_unr(sc->sc_unr, in->in_station);
86528a38073SDamien Bergamini 
86628a38073SDamien Bergamini 	sc->sc_node_free(ni);
86728a38073SDamien Bergamini }
86828a38073SDamien Bergamini 
869ceaec73dSDamien Bergamini static int
870ceaec73dSDamien Bergamini iwi_media_change(struct ifnet *ifp)
871ceaec73dSDamien Bergamini {
872ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
873ceaec73dSDamien Bergamini 	int error;
874ceaec73dSDamien Bergamini 
875ceaec73dSDamien Bergamini 	IWI_LOCK(sc);
876ceaec73dSDamien Bergamini 
877ceaec73dSDamien Bergamini 	error = ieee80211_media_change(ifp);
878ceaec73dSDamien Bergamini 	if (error != ENETRESET) {
879ceaec73dSDamien Bergamini 		IWI_UNLOCK(sc);
880ceaec73dSDamien Bergamini 		return error;
881ceaec73dSDamien Bergamini 	}
882ceaec73dSDamien Bergamini 
88313f4c340SRobert Watson 	if ((ifp->if_flags & IFF_UP) && (ifp->if_drv_flags & IFF_DRV_RUNNING))
884ceaec73dSDamien Bergamini 		iwi_init(sc);
885ceaec73dSDamien Bergamini 
886ceaec73dSDamien Bergamini 	IWI_UNLOCK(sc);
887ceaec73dSDamien Bergamini 
888ceaec73dSDamien Bergamini 	return 0;
889ceaec73dSDamien Bergamini }
890ceaec73dSDamien Bergamini 
891ceaec73dSDamien Bergamini /*
89228a38073SDamien Bergamini  * The firmware automatically adapts the transmit speed.  We report its current
89328a38073SDamien Bergamini  * value here.
894ceaec73dSDamien Bergamini  */
895ceaec73dSDamien Bergamini static void
896ceaec73dSDamien Bergamini iwi_media_status(struct ifnet *ifp, struct ifmediareq *imr)
897ceaec73dSDamien Bergamini {
898ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
899ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
900ceaec73dSDamien Bergamini #define N(a)	(sizeof (a) / sizeof (a[0]))
901ceaec73dSDamien Bergamini 	static const struct {
902ceaec73dSDamien Bergamini 		uint32_t	val;
903ceaec73dSDamien Bergamini 		int		rate;
904ceaec73dSDamien Bergamini 	} rates[] = {
905ceaec73dSDamien Bergamini 		{ IWI_RATE_DS1,      2 },
906ceaec73dSDamien Bergamini 		{ IWI_RATE_DS2,      4 },
907ceaec73dSDamien Bergamini 		{ IWI_RATE_DS5,     11 },
908ceaec73dSDamien Bergamini 		{ IWI_RATE_DS11,    22 },
909ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM6,   12 },
910ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM9,   18 },
911ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM12,  24 },
912ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM18,  36 },
913ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM24,  48 },
914ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM36,  72 },
915ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM48,  96 },
916ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM54, 108 },
917ceaec73dSDamien Bergamini 	};
918ceaec73dSDamien Bergamini 	uint32_t val;
919ceaec73dSDamien Bergamini 	int rate, i;
920ceaec73dSDamien Bergamini 
921ceaec73dSDamien Bergamini 	imr->ifm_status = IFM_AVALID;
922ceaec73dSDamien Bergamini 	imr->ifm_active = IFM_IEEE80211;
923ceaec73dSDamien Bergamini 	if (ic->ic_state == IEEE80211_S_RUN)
924ceaec73dSDamien Bergamini 		imr->ifm_status |= IFM_ACTIVE;
925ceaec73dSDamien Bergamini 
926ceaec73dSDamien Bergamini 	/* read current transmission rate from adapter */
927ceaec73dSDamien Bergamini 	val = CSR_READ_4(sc, IWI_CSR_CURRENT_TX_RATE);
928ceaec73dSDamien Bergamini 
929ceaec73dSDamien Bergamini 	/* convert rate to 802.11 rate */
930ceaec73dSDamien Bergamini 	for (i = 0; i < N(rates) && rates[i].val != val; i++);
931ceaec73dSDamien Bergamini 	rate = (i < N(rates)) ? rates[i].rate : 0;
932ceaec73dSDamien Bergamini 
933ceaec73dSDamien Bergamini 	imr->ifm_active |= ieee80211_rate2media(ic, rate, ic->ic_curmode);
934ceaec73dSDamien Bergamini 	switch (ic->ic_opmode) {
935ceaec73dSDamien Bergamini 	case IEEE80211_M_STA:
936ceaec73dSDamien Bergamini 		break;
937ceaec73dSDamien Bergamini 
938ceaec73dSDamien Bergamini 	case IEEE80211_M_IBSS:
939ceaec73dSDamien Bergamini 		imr->ifm_active |= IFM_IEEE80211_ADHOC;
940ceaec73dSDamien Bergamini 		break;
941ceaec73dSDamien Bergamini 
942ceaec73dSDamien Bergamini 	case IEEE80211_M_MONITOR:
943ceaec73dSDamien Bergamini 		imr->ifm_active |= IFM_IEEE80211_MONITOR;
944ceaec73dSDamien Bergamini 		break;
945ceaec73dSDamien Bergamini 
946ceaec73dSDamien Bergamini 	case IEEE80211_M_AHDEMO:
947ceaec73dSDamien Bergamini 	case IEEE80211_M_HOSTAP:
948ceaec73dSDamien Bergamini 		/* should not get there */
949ceaec73dSDamien Bergamini 		break;
950ceaec73dSDamien Bergamini 	}
951ceaec73dSDamien Bergamini #undef N
952ceaec73dSDamien Bergamini }
953ceaec73dSDamien Bergamini 
954ceaec73dSDamien Bergamini static int
955ceaec73dSDamien Bergamini iwi_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
956ceaec73dSDamien Bergamini {
957ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
958ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
959ceaec73dSDamien Bergamini 
960ceaec73dSDamien Bergamini 	switch (nstate) {
961ceaec73dSDamien Bergamini 	case IEEE80211_S_SCAN:
962acea4241SDamien Bergamini 		if (sc->flags & IWI_FLAG_SCANNING)
963acea4241SDamien Bergamini 			break;
964acea4241SDamien Bergamini 
965acea4241SDamien Bergamini 		ieee80211_node_table_reset(&ic->ic_scan);
966acea4241SDamien Bergamini 		ic->ic_flags |= IEEE80211_F_SCAN | IEEE80211_F_ASCAN;
967acea4241SDamien Bergamini 		sc->flags |= IWI_FLAG_SCANNING;
968ceaec73dSDamien Bergamini 		iwi_scan(sc);
969ceaec73dSDamien Bergamini 		break;
970ceaec73dSDamien Bergamini 
971ceaec73dSDamien Bergamini 	case IEEE80211_S_AUTH:
972ceaec73dSDamien Bergamini 		iwi_auth_and_assoc(sc);
973ceaec73dSDamien Bergamini 		break;
974ceaec73dSDamien Bergamini 
975ceaec73dSDamien Bergamini 	case IEEE80211_S_RUN:
976ceaec73dSDamien Bergamini 		if (ic->ic_opmode == IEEE80211_M_IBSS)
977ceaec73dSDamien Bergamini 			ieee80211_new_state(ic, IEEE80211_S_AUTH, -1);
978acea4241SDamien Bergamini 		else if (ic->ic_opmode == IEEE80211_M_MONITOR)
979acea4241SDamien Bergamini 			iwi_set_chan(sc, ic->ic_ibss_chan);
980acea4241SDamien Bergamini 
981acea4241SDamien Bergamini 		return sc->sc_newstate(ic, nstate,
982acea4241SDamien Bergamini 		    IEEE80211_FC0_SUBTYPE_ASSOC_RESP);
983ceaec73dSDamien Bergamini 
984ceaec73dSDamien Bergamini 	case IEEE80211_S_ASSOC:
985acea4241SDamien Bergamini 		break;
986acea4241SDamien Bergamini 
987ceaec73dSDamien Bergamini 	case IEEE80211_S_INIT:
988acea4241SDamien Bergamini 		sc->flags &= ~IWI_FLAG_SCANNING;
989ceaec73dSDamien Bergamini 		break;
990ceaec73dSDamien Bergamini 	}
991ceaec73dSDamien Bergamini 
992ceaec73dSDamien Bergamini 	ic->ic_state = nstate;
993ceaec73dSDamien Bergamini 	return 0;
994ceaec73dSDamien Bergamini }
995ceaec73dSDamien Bergamini 
996fb533d55SDamien Bergamini /*
997fb533d55SDamien Bergamini  * WME parameters coming from IEEE 802.11e specification.  These values are
998fb533d55SDamien Bergamini  * already declared in ieee80211_proto.c, but they are static so they can't
999fb533d55SDamien Bergamini  * be reused here.
1000fb533d55SDamien Bergamini  */
1001fb533d55SDamien Bergamini static const struct wmeParams iwi_wme_cck_params[WME_NUM_AC] = {
1002fb533d55SDamien Bergamini 	{ 0, 3, 5,  7,   0 },	/* WME_AC_BE */
1003fb533d55SDamien Bergamini 	{ 0, 3, 5, 10,   0 },	/* WME_AC_BK */
1004fb533d55SDamien Bergamini 	{ 0, 2, 4,  5, 188 },	/* WME_AC_VI */
1005fb533d55SDamien Bergamini 	{ 0, 2, 3,  4, 102 }	/* WME_AC_VO */
1006fb533d55SDamien Bergamini };
1007fb533d55SDamien Bergamini 
1008fb533d55SDamien Bergamini static const struct wmeParams iwi_wme_ofdm_params[WME_NUM_AC] = {
1009fb533d55SDamien Bergamini 	{ 0, 3, 4,  6,   0 },	/* WME_AC_BE */
1010fb533d55SDamien Bergamini 	{ 0, 3, 4, 10,   0 },	/* WME_AC_BK */
1011fb533d55SDamien Bergamini 	{ 0, 2, 3,  4,  94 },	/* WME_AC_VI */
1012fb533d55SDamien Bergamini 	{ 0, 2, 2,  3,  47 }	/* WME_AC_VO */
1013fb533d55SDamien Bergamini };
1014fb533d55SDamien Bergamini 
1015ec01dc2bSDamien Bergamini static int
1016ec01dc2bSDamien Bergamini iwi_wme_update(struct ieee80211com *ic)
1017ec01dc2bSDamien Bergamini {
1018fb533d55SDamien Bergamini #define IWI_EXP2(v)	htole16((1 << (v)) - 1)
1019fb533d55SDamien Bergamini #define IWI_USEC(v)	htole16(IEEE80211_TXOP_TO_US(v))
1020fb533d55SDamien Bergamini 	struct iwi_softc *sc = ic->ic_ifp->if_softc;
1021fb533d55SDamien Bergamini 	struct iwi_wme_params wme[3];
1022fb533d55SDamien Bergamini 	const struct wmeParams *wmep;
1023fb533d55SDamien Bergamini 	int ac;
1024ec01dc2bSDamien Bergamini 
1025fb533d55SDamien Bergamini 	/*
1026fb533d55SDamien Bergamini 	 * We shall not override firmware default WME values if WME is not
1027fb533d55SDamien Bergamini 	 * actually enabled.
1028fb533d55SDamien Bergamini 	 */
1029fb533d55SDamien Bergamini 	if (!(ic->ic_flags & IEEE80211_F_WME))
1030ec01dc2bSDamien Bergamini 		return 0;
1031fb533d55SDamien Bergamini 
1032fb533d55SDamien Bergamini 	for (ac = 0; ac < WME_NUM_AC; ac++) {
1033fb533d55SDamien Bergamini 		/* set WME values for current operating mode */
1034fb533d55SDamien Bergamini 		wmep = &ic->ic_wme.wme_chanParams.cap_wmeParams[ac];
1035fb533d55SDamien Bergamini 		wme[0].aifsn[ac] = wmep->wmep_aifsn;
1036fb533d55SDamien Bergamini 		wme[0].cwmin[ac] = IWI_EXP2(wmep->wmep_logcwmin);
1037fb533d55SDamien Bergamini 		wme[0].cwmax[ac] = IWI_EXP2(wmep->wmep_logcwmax);
1038fb533d55SDamien Bergamini 		wme[0].burst[ac] = IWI_USEC(wmep->wmep_txopLimit);
1039fb533d55SDamien Bergamini 		wme[0].acm[ac]   = wmep->wmep_acm;
1040fb533d55SDamien Bergamini 
1041fb533d55SDamien Bergamini 		/* set WME values for CCK modulation */
1042fb533d55SDamien Bergamini 		wmep = &iwi_wme_cck_params[ac];
1043fb533d55SDamien Bergamini 		wme[1].aifsn[ac] = wmep->wmep_aifsn;
1044fb533d55SDamien Bergamini 		wme[1].cwmin[ac] = IWI_EXP2(wmep->wmep_logcwmin);
1045fb533d55SDamien Bergamini 		wme[1].cwmax[ac] = IWI_EXP2(wmep->wmep_logcwmax);
1046fb533d55SDamien Bergamini 		wme[1].burst[ac] = IWI_USEC(wmep->wmep_txopLimit);
1047fb533d55SDamien Bergamini 		wme[1].acm[ac]   = wmep->wmep_acm;
1048fb533d55SDamien Bergamini 
1049fb533d55SDamien Bergamini 		/* set WME values for OFDM modulation */
1050fb533d55SDamien Bergamini 		wmep = &iwi_wme_ofdm_params[ac];
1051fb533d55SDamien Bergamini 		wme[2].aifsn[ac] = wmep->wmep_aifsn;
1052fb533d55SDamien Bergamini 		wme[2].cwmin[ac] = IWI_EXP2(wmep->wmep_logcwmin);
1053fb533d55SDamien Bergamini 		wme[2].cwmax[ac] = IWI_EXP2(wmep->wmep_logcwmax);
1054fb533d55SDamien Bergamini 		wme[2].burst[ac] = IWI_USEC(wmep->wmep_txopLimit);
1055fb533d55SDamien Bergamini 		wme[2].acm[ac]   = wmep->wmep_acm;
1056fb533d55SDamien Bergamini 	}
1057fb533d55SDamien Bergamini 
1058fb533d55SDamien Bergamini 	DPRINTF(("Setting WME parameters\n"));
1059fb533d55SDamien Bergamini 	return iwi_cmd(sc, IWI_CMD_SET_WME_PARAMS, wme, sizeof wme, 1);
1060fb533d55SDamien Bergamini #undef IWI_USEC
1061fb533d55SDamien Bergamini #undef IWI_EXP2
1062ec01dc2bSDamien Bergamini }
1063ec01dc2bSDamien Bergamini 
1064ceaec73dSDamien Bergamini /*
1065ceaec73dSDamien Bergamini  * Read 16 bits at address 'addr' from the serial EEPROM.
1066ceaec73dSDamien Bergamini  */
1067ceaec73dSDamien Bergamini static uint16_t
1068ceaec73dSDamien Bergamini iwi_read_prom_word(struct iwi_softc *sc, uint8_t addr)
1069ceaec73dSDamien Bergamini {
1070ceaec73dSDamien Bergamini 	uint32_t tmp;
1071ceaec73dSDamien Bergamini 	uint16_t val;
1072ceaec73dSDamien Bergamini 	int n;
1073ceaec73dSDamien Bergamini 
1074ceaec73dSDamien Bergamini 	/* clock C once before the first command */
1075ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, 0);
1076ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S);
1077ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_C);
1078ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S);
1079ceaec73dSDamien Bergamini 
1080ceaec73dSDamien Bergamini 	/* write start bit (1) */
1081ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_D);
1082ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_D | IWI_EEPROM_C);
1083ceaec73dSDamien Bergamini 
1084ceaec73dSDamien Bergamini 	/* write READ opcode (10) */
1085ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_D);
1086ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_D | IWI_EEPROM_C);
1087ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S);
1088ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_C);
1089ceaec73dSDamien Bergamini 
1090ceaec73dSDamien Bergamini 	/* write address A7-A0 */
1091ceaec73dSDamien Bergamini 	for (n = 7; n >= 0; n--) {
1092ceaec73dSDamien Bergamini 		IWI_EEPROM_CTL(sc, IWI_EEPROM_S |
1093ceaec73dSDamien Bergamini 		    (((addr >> n) & 1) << IWI_EEPROM_SHIFT_D));
1094ceaec73dSDamien Bergamini 		IWI_EEPROM_CTL(sc, IWI_EEPROM_S |
1095ceaec73dSDamien Bergamini 		    (((addr >> n) & 1) << IWI_EEPROM_SHIFT_D) | IWI_EEPROM_C);
1096ceaec73dSDamien Bergamini 	}
1097ceaec73dSDamien Bergamini 
1098ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S);
1099ceaec73dSDamien Bergamini 
1100ceaec73dSDamien Bergamini 	/* read data Q15-Q0 */
1101ceaec73dSDamien Bergamini 	val = 0;
1102ceaec73dSDamien Bergamini 	for (n = 15; n >= 0; n--) {
1103ceaec73dSDamien Bergamini 		IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_C);
1104ceaec73dSDamien Bergamini 		IWI_EEPROM_CTL(sc, IWI_EEPROM_S);
1105ceaec73dSDamien Bergamini 		tmp = MEM_READ_4(sc, IWI_MEM_EEPROM_CTL);
1106ceaec73dSDamien Bergamini 		val |= ((tmp & IWI_EEPROM_Q) >> IWI_EEPROM_SHIFT_Q) << n;
1107ceaec73dSDamien Bergamini 	}
1108ceaec73dSDamien Bergamini 
1109ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, 0);
1110ceaec73dSDamien Bergamini 
1111ceaec73dSDamien Bergamini 	/* clear Chip Select and clock C */
1112ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S);
1113ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, 0);
1114ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_C);
1115ceaec73dSDamien Bergamini 
111681e6343cSDamien Bergamini 	return val;
1117ceaec73dSDamien Bergamini }
1118ceaec73dSDamien Bergamini 
1119ceaec73dSDamien Bergamini /*
1120ceaec73dSDamien Bergamini  * XXX: Hack to set the current channel to the value advertised in beacons or
1121ceaec73dSDamien Bergamini  * probe responses. Only used during AP detection.
1122ceaec73dSDamien Bergamini  */
1123ceaec73dSDamien Bergamini static void
1124ceaec73dSDamien Bergamini iwi_fix_channel(struct ieee80211com *ic, struct mbuf *m)
1125ceaec73dSDamien Bergamini {
1126ceaec73dSDamien Bergamini 	struct ieee80211_frame *wh;
1127ceaec73dSDamien Bergamini 	uint8_t subtype;
1128ceaec73dSDamien Bergamini 	uint8_t *frm, *efrm;
1129ceaec73dSDamien Bergamini 
1130ceaec73dSDamien Bergamini 	wh = mtod(m, struct ieee80211_frame *);
1131ceaec73dSDamien Bergamini 
1132ceaec73dSDamien Bergamini 	if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) != IEEE80211_FC0_TYPE_MGT)
1133ceaec73dSDamien Bergamini 		return;
1134ceaec73dSDamien Bergamini 
1135ceaec73dSDamien Bergamini 	subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;
1136ceaec73dSDamien Bergamini 
1137ceaec73dSDamien Bergamini 	if (subtype != IEEE80211_FC0_SUBTYPE_BEACON &&
1138ceaec73dSDamien Bergamini 	    subtype != IEEE80211_FC0_SUBTYPE_PROBE_RESP)
1139ceaec73dSDamien Bergamini 		return;
1140ceaec73dSDamien Bergamini 
1141ceaec73dSDamien Bergamini 	frm = (uint8_t *)(wh + 1);
1142ceaec73dSDamien Bergamini 	efrm = mtod(m, uint8_t *) + m->m_len;
1143ceaec73dSDamien Bergamini 
1144ceaec73dSDamien Bergamini 	frm += 12;	/* skip tstamp, bintval and capinfo fields */
1145ceaec73dSDamien Bergamini 	while (frm < efrm) {
1146ceaec73dSDamien Bergamini 		if (*frm == IEEE80211_ELEMID_DSPARMS)
1147ceaec73dSDamien Bergamini #if IEEE80211_CHAN_MAX < 255
1148ceaec73dSDamien Bergamini 		if (frm[2] <= IEEE80211_CHAN_MAX)
1149ceaec73dSDamien Bergamini #endif
115045f3f78cSJohn Baldwin 			ic->ic_curchan = &ic->ic_channels[frm[2]];
1151ceaec73dSDamien Bergamini 
1152ceaec73dSDamien Bergamini 		frm += frm[1] + 2;
1153ceaec73dSDamien Bergamini 	}
1154ceaec73dSDamien Bergamini }
1155ceaec73dSDamien Bergamini 
1156ceaec73dSDamien Bergamini static void
1157ceaec73dSDamien Bergamini iwi_frame_intr(struct iwi_softc *sc, struct iwi_rx_data *data, int i,
1158ceaec73dSDamien Bergamini     struct iwi_frame *frame)
1159ceaec73dSDamien Bergamini {
1160ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1161ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
116246c34436SDamien Bergamini 	struct mbuf *mnew, *m;
1163ceaec73dSDamien Bergamini 	struct ieee80211_frame *wh;
1164ceaec73dSDamien Bergamini 	struct ieee80211_node *ni;
1165ceaec73dSDamien Bergamini 	int error;
1166ceaec73dSDamien Bergamini 
1167ceaec73dSDamien Bergamini 	DPRINTFN(5, ("received frame len=%u chan=%u rssi=%u\n",
1168ceaec73dSDamien Bergamini 	    le16toh(frame->len), frame->chan, frame->rssi_dbm));
1169ceaec73dSDamien Bergamini 
1170acea4241SDamien Bergamini 	if (le16toh(frame->len) < sizeof (struct ieee80211_frame))
1171acea4241SDamien Bergamini 		return;
1172acea4241SDamien Bergamini 
117346c34436SDamien Bergamini 	/*
117446c34436SDamien Bergamini 	 * Try to allocate a new mbuf for this ring element and load it before
117546c34436SDamien Bergamini 	 * processing the current mbuf. If the ring element cannot be loaded,
117646c34436SDamien Bergamini 	 * drop the received packet and reuse the old mbuf. In the unlikely
117746c34436SDamien Bergamini 	 * case that the old mbuf can't be reloaded either, explicitly panic.
117846c34436SDamien Bergamini 	 */
117946c34436SDamien Bergamini 	mnew = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR);
118046c34436SDamien Bergamini 	if (mnew == NULL) {
118146c34436SDamien Bergamini 		ifp->if_ierrors++;
118246c34436SDamien Bergamini 		return;
118346c34436SDamien Bergamini 	}
118446c34436SDamien Bergamini 
1185ceaec73dSDamien Bergamini 	bus_dmamap_unload(sc->rxq.data_dmat, data->map);
1186ceaec73dSDamien Bergamini 
118746c34436SDamien Bergamini 	error = bus_dmamap_load(sc->rxq.data_dmat, data->map,
118846c34436SDamien Bergamini 	    mtod(mnew, void *), MCLBYTES, iwi_dma_map_addr, &data->physaddr,
118946c34436SDamien Bergamini 	    0);
119046c34436SDamien Bergamini 	if (error != 0) {
119146c34436SDamien Bergamini 		m_freem(mnew);
119246c34436SDamien Bergamini 
119346c34436SDamien Bergamini 		/* try to reload the old mbuf */
119446c34436SDamien Bergamini 		error = bus_dmamap_load(sc->rxq.data_dmat, data->map,
119546c34436SDamien Bergamini 		    mtod(data->m, void *), MCLBYTES, iwi_dma_map_addr,
119646c34436SDamien Bergamini 		    &data->physaddr, 0);
119746c34436SDamien Bergamini 		if (error != 0) {
119846c34436SDamien Bergamini 			/* very unlikely that it will fail... */
119946c34436SDamien Bergamini 			panic("%s: could not load old rx mbuf",
120046c34436SDamien Bergamini 			    device_get_name(sc->sc_dev));
120146c34436SDamien Bergamini 		}
120246c34436SDamien Bergamini 		ifp->if_ierrors++;
120346c34436SDamien Bergamini 		return;
120446c34436SDamien Bergamini 	}
120546c34436SDamien Bergamini 
120646c34436SDamien Bergamini 	/*
120746c34436SDamien Bergamini 	 * New mbuf successfully loaded, update Rx ring and continue
120846c34436SDamien Bergamini 	 * processing.
120946c34436SDamien Bergamini 	 */
1210ceaec73dSDamien Bergamini 	m = data->m;
121146c34436SDamien Bergamini 	data->m = mnew;
121246c34436SDamien Bergamini 	CSR_WRITE_4(sc, data->reg, data->physaddr);
121346c34436SDamien Bergamini 
121446c34436SDamien Bergamini 	/* finalize mbuf */
1215ceaec73dSDamien Bergamini 	m->m_pkthdr.rcvif = ifp;
1216ceaec73dSDamien Bergamini 	m->m_pkthdr.len = m->m_len = sizeof (struct iwi_hdr) +
1217ceaec73dSDamien Bergamini 	    sizeof (struct iwi_frame) + le16toh(frame->len);
1218ceaec73dSDamien Bergamini 
1219ceaec73dSDamien Bergamini 	m_adj(m, sizeof (struct iwi_hdr) + sizeof (struct iwi_frame));
1220ceaec73dSDamien Bergamini 
1221ceaec73dSDamien Bergamini 	if (ic->ic_state == IEEE80211_S_SCAN)
1222ceaec73dSDamien Bergamini 		iwi_fix_channel(ic, m);
1223ceaec73dSDamien Bergamini 
1224ceaec73dSDamien Bergamini 	if (sc->sc_drvbpf != NULL) {
1225ceaec73dSDamien Bergamini 		struct iwi_rx_radiotap_header *tap = &sc->sc_rxtap;
1226ceaec73dSDamien Bergamini 
1227ceaec73dSDamien Bergamini 		tap->wr_flags = 0;
1228ceaec73dSDamien Bergamini 		tap->wr_rate = frame->rate;
1229ceaec73dSDamien Bergamini 		tap->wr_chan_freq =
1230ceaec73dSDamien Bergamini 		    htole16(ic->ic_channels[frame->chan].ic_freq);
1231ceaec73dSDamien Bergamini 		tap->wr_chan_flags =
1232ceaec73dSDamien Bergamini 		    htole16(ic->ic_channels[frame->chan].ic_flags);
1233ceaec73dSDamien Bergamini 		tap->wr_antsignal = frame->signal;
1234ceaec73dSDamien Bergamini 		tap->wr_antenna = frame->antenna;
1235ceaec73dSDamien Bergamini 
1236ceaec73dSDamien Bergamini 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_rxtap_len, m);
1237ceaec73dSDamien Bergamini 	}
1238ceaec73dSDamien Bergamini 
1239ceaec73dSDamien Bergamini 	wh = mtod(m, struct ieee80211_frame *);
1240ceaec73dSDamien Bergamini 	ni = ieee80211_find_rxnode(ic, (struct ieee80211_frame_min *)wh);
1241ceaec73dSDamien Bergamini 
1242ceaec73dSDamien Bergamini 	/* send the frame to the 802.11 layer */
1243acea4241SDamien Bergamini 	ieee80211_input(ic, m, ni, frame->rssi_dbm, 0);
1244ceaec73dSDamien Bergamini 
1245ceaec73dSDamien Bergamini 	/* node is no longer needed */
1246ceaec73dSDamien Bergamini 	ieee80211_free_node(ni);
1247ceaec73dSDamien Bergamini }
1248ceaec73dSDamien Bergamini 
1249ceaec73dSDamien Bergamini static void
1250ceaec73dSDamien Bergamini iwi_notification_intr(struct iwi_softc *sc, struct iwi_notif *notif)
1251ceaec73dSDamien Bergamini {
1252ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1253ceaec73dSDamien Bergamini 	struct iwi_notif_scan_channel *chan;
1254ceaec73dSDamien Bergamini 	struct iwi_notif_scan_complete *scan;
1255ceaec73dSDamien Bergamini 	struct iwi_notif_authentication *auth;
1256ceaec73dSDamien Bergamini 	struct iwi_notif_association *assoc;
1257ceaec73dSDamien Bergamini 
1258ceaec73dSDamien Bergamini 	switch (notif->type) {
1259ceaec73dSDamien Bergamini 	case IWI_NOTIF_TYPE_SCAN_CHANNEL:
1260ceaec73dSDamien Bergamini 		chan = (struct iwi_notif_scan_channel *)(notif + 1);
1261ceaec73dSDamien Bergamini 
1262ceaec73dSDamien Bergamini 		DPRINTFN(2, ("Scanning channel (%u)\n", chan->nchan));
1263ceaec73dSDamien Bergamini 		break;
1264ceaec73dSDamien Bergamini 
1265ceaec73dSDamien Bergamini 	case IWI_NOTIF_TYPE_SCAN_COMPLETE:
1266ceaec73dSDamien Bergamini 		scan = (struct iwi_notif_scan_complete *)(notif + 1);
1267ceaec73dSDamien Bergamini 
1268ceaec73dSDamien Bergamini 		DPRINTFN(2, ("Scan completed (%u, %u)\n", scan->nchan,
1269ceaec73dSDamien Bergamini 		    scan->status));
1270ceaec73dSDamien Bergamini 
1271acea4241SDamien Bergamini 		/* monitor mode uses scan to set the channel ... */
1272acea4241SDamien Bergamini 		if (ic->ic_opmode != IEEE80211_M_MONITOR) {
1273acea4241SDamien Bergamini 			sc->flags &= ~IWI_FLAG_SCANNING;
1274ceaec73dSDamien Bergamini 			ieee80211_end_scan(ic);
1275acea4241SDamien Bergamini 		} else
1276acea4241SDamien Bergamini 			iwi_set_chan(sc, ic->ic_ibss_chan);
1277ceaec73dSDamien Bergamini 		break;
1278ceaec73dSDamien Bergamini 
1279ceaec73dSDamien Bergamini 	case IWI_NOTIF_TYPE_AUTHENTICATION:
1280ceaec73dSDamien Bergamini 		auth = (struct iwi_notif_authentication *)(notif + 1);
1281ceaec73dSDamien Bergamini 
1282ceaec73dSDamien Bergamini 		DPRINTFN(2, ("Authentication (%u)\n", auth->state));
1283ceaec73dSDamien Bergamini 
1284ceaec73dSDamien Bergamini 		switch (auth->state) {
1285ceaec73dSDamien Bergamini 		case IWI_AUTHENTICATED:
1286e4918ecdSSam Leffler 			ieee80211_node_authorize(ic->ic_bss);
1287ceaec73dSDamien Bergamini 			ieee80211_new_state(ic, IEEE80211_S_ASSOC, -1);
1288ceaec73dSDamien Bergamini 			break;
1289ceaec73dSDamien Bergamini 
1290ceaec73dSDamien Bergamini 		case IWI_DEAUTHENTICATED:
1291ceaec73dSDamien Bergamini 			break;
1292ceaec73dSDamien Bergamini 
1293ceaec73dSDamien Bergamini 		default:
1294ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
1295ceaec73dSDamien Bergamini 			    "unknown authentication state %u\n", auth->state);
1296ceaec73dSDamien Bergamini 		}
1297ceaec73dSDamien Bergamini 		break;
1298ceaec73dSDamien Bergamini 
1299ceaec73dSDamien Bergamini 	case IWI_NOTIF_TYPE_ASSOCIATION:
1300ceaec73dSDamien Bergamini 		assoc = (struct iwi_notif_association *)(notif + 1);
1301ceaec73dSDamien Bergamini 
1302ceaec73dSDamien Bergamini 		DPRINTFN(2, ("Association (%u, %u)\n", assoc->state,
1303ceaec73dSDamien Bergamini 		    assoc->status));
1304ceaec73dSDamien Bergamini 
1305ceaec73dSDamien Bergamini 		switch (assoc->state) {
1306ceaec73dSDamien Bergamini 		case IWI_AUTHENTICATED:
1307ceaec73dSDamien Bergamini 			/* re-association, do nothing */
1308ceaec73dSDamien Bergamini 			break;
1309ceaec73dSDamien Bergamini 
1310ceaec73dSDamien Bergamini 		case IWI_ASSOCIATED:
1311ceaec73dSDamien Bergamini 			ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
1312ceaec73dSDamien Bergamini 			break;
1313ceaec73dSDamien Bergamini 
1314ceaec73dSDamien Bergamini 		case IWI_DEASSOCIATED:
1315ceaec73dSDamien Bergamini 			ieee80211_begin_scan(ic, 1);
1316ceaec73dSDamien Bergamini 			break;
1317ceaec73dSDamien Bergamini 
1318ceaec73dSDamien Bergamini 		default:
1319ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
1320ceaec73dSDamien Bergamini 			    "unknown association state %u\n", assoc->state);
1321ceaec73dSDamien Bergamini 		}
1322ceaec73dSDamien Bergamini 		break;
1323ceaec73dSDamien Bergamini 
1324ceaec73dSDamien Bergamini 	case IWI_NOTIF_TYPE_CALIBRATION:
1325ceaec73dSDamien Bergamini 	case IWI_NOTIF_TYPE_BEACON:
1326ceaec73dSDamien Bergamini 	case IWI_NOTIF_TYPE_NOISE:
1327ceaec73dSDamien Bergamini 		DPRINTFN(5, ("Notification (%u)\n", notif->type));
1328ceaec73dSDamien Bergamini 		break;
1329ceaec73dSDamien Bergamini 
1330ceaec73dSDamien Bergamini 	default:
1331ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "unknown notification type %u\n",
1332ceaec73dSDamien Bergamini 		    notif->type);
1333ceaec73dSDamien Bergamini 	}
1334ceaec73dSDamien Bergamini }
1335ceaec73dSDamien Bergamini 
1336ceaec73dSDamien Bergamini static void
1337ceaec73dSDamien Bergamini iwi_rx_intr(struct iwi_softc *sc)
1338ceaec73dSDamien Bergamini {
1339ceaec73dSDamien Bergamini 	struct iwi_rx_data *data;
1340ceaec73dSDamien Bergamini 	struct iwi_hdr *hdr;
1341ceaec73dSDamien Bergamini 	uint32_t hw;
1342ceaec73dSDamien Bergamini 
1343ceaec73dSDamien Bergamini 	hw = CSR_READ_4(sc, IWI_CSR_RX_RIDX);
1344ceaec73dSDamien Bergamini 
1345ceaec73dSDamien Bergamini 	for (; sc->rxq.cur != hw;) {
1346ceaec73dSDamien Bergamini 		data = &sc->rxq.data[sc->rxq.cur];
1347ceaec73dSDamien Bergamini 
1348ceaec73dSDamien Bergamini 		bus_dmamap_sync(sc->rxq.data_dmat, data->map,
1349ceaec73dSDamien Bergamini 		    BUS_DMASYNC_POSTREAD);
1350ceaec73dSDamien Bergamini 
1351ceaec73dSDamien Bergamini 		hdr = mtod(data->m, struct iwi_hdr *);
1352ceaec73dSDamien Bergamini 
1353ceaec73dSDamien Bergamini 		switch (hdr->type) {
1354ceaec73dSDamien Bergamini 		case IWI_HDR_TYPE_FRAME:
1355ceaec73dSDamien Bergamini 			iwi_frame_intr(sc, data, sc->rxq.cur,
1356ceaec73dSDamien Bergamini 			    (struct iwi_frame *)(hdr + 1));
1357ceaec73dSDamien Bergamini 			break;
1358ceaec73dSDamien Bergamini 
1359ceaec73dSDamien Bergamini 		case IWI_HDR_TYPE_NOTIF:
1360ceaec73dSDamien Bergamini 			iwi_notification_intr(sc,
1361ceaec73dSDamien Bergamini 			    (struct iwi_notif *)(hdr + 1));
1362ceaec73dSDamien Bergamini 			break;
1363ceaec73dSDamien Bergamini 
1364ceaec73dSDamien Bergamini 		default:
1365ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev, "unknown hdr type %u\n",
1366ceaec73dSDamien Bergamini 			    hdr->type);
1367ceaec73dSDamien Bergamini 		}
1368ceaec73dSDamien Bergamini 
1369ceaec73dSDamien Bergamini 		DPRINTFN(15, ("rx done idx=%u\n", sc->rxq.cur));
1370ceaec73dSDamien Bergamini 
1371ceaec73dSDamien Bergamini 		sc->rxq.cur = (sc->rxq.cur + 1) % IWI_RX_RING_COUNT;
1372ceaec73dSDamien Bergamini 	}
1373ceaec73dSDamien Bergamini 
1374ceaec73dSDamien Bergamini 	/* tell the firmware what we have processed */
1375ceaec73dSDamien Bergamini 	hw = (hw == 0) ? IWI_RX_RING_COUNT - 1 : hw - 1;
1376ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RX_WIDX, hw);
1377ceaec73dSDamien Bergamini }
1378ceaec73dSDamien Bergamini 
1379ceaec73dSDamien Bergamini static void
1380ec01dc2bSDamien Bergamini iwi_tx_intr(struct iwi_softc *sc, struct iwi_tx_ring *txq)
1381ceaec73dSDamien Bergamini {
1382ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1383ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
1384ceaec73dSDamien Bergamini 	struct iwi_tx_data *data;
1385ceaec73dSDamien Bergamini 	uint32_t hw;
1386ceaec73dSDamien Bergamini 
1387ec01dc2bSDamien Bergamini 	hw = CSR_READ_4(sc, txq->csr_ridx);
1388ceaec73dSDamien Bergamini 
1389ec01dc2bSDamien Bergamini 	for (; txq->next != hw;) {
1390ec01dc2bSDamien Bergamini 		data = &txq->data[txq->next];
1391ceaec73dSDamien Bergamini 
1392ec01dc2bSDamien Bergamini 		bus_dmamap_sync(txq->data_dmat, data->map,
1393ceaec73dSDamien Bergamini 		    BUS_DMASYNC_POSTWRITE);
1394ec01dc2bSDamien Bergamini 		bus_dmamap_unload(txq->data_dmat, data->map);
1395ceaec73dSDamien Bergamini 		m_freem(data->m);
1396ceaec73dSDamien Bergamini 		data->m = NULL;
1397ceaec73dSDamien Bergamini 		ieee80211_free_node(data->ni);
1398ceaec73dSDamien Bergamini 		data->ni = NULL;
1399ceaec73dSDamien Bergamini 
1400ec01dc2bSDamien Bergamini 		DPRINTFN(15, ("tx done idx=%u\n", txq->next));
1401ceaec73dSDamien Bergamini 
1402ceaec73dSDamien Bergamini 		ifp->if_opackets++;
1403ceaec73dSDamien Bergamini 
1404ec01dc2bSDamien Bergamini 		txq->queued--;
1405ec01dc2bSDamien Bergamini 		txq->next = (txq->next + 1) % IWI_TX_RING_COUNT;
1406ceaec73dSDamien Bergamini 	}
1407ceaec73dSDamien Bergamini 
1408ceaec73dSDamien Bergamini 	sc->sc_tx_timer = 0;
140913f4c340SRobert Watson 	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1410ceaec73dSDamien Bergamini 	iwi_start(ifp);
1411ceaec73dSDamien Bergamini }
1412ceaec73dSDamien Bergamini 
1413ceaec73dSDamien Bergamini static void
1414ceaec73dSDamien Bergamini iwi_intr(void *arg)
1415ceaec73dSDamien Bergamini {
1416ceaec73dSDamien Bergamini 	struct iwi_softc *sc = arg;
1417ceaec73dSDamien Bergamini 	uint32_t r;
1418ceaec73dSDamien Bergamini 
1419ceaec73dSDamien Bergamini 	IWI_LOCK(sc);
1420ceaec73dSDamien Bergamini 
1421ceaec73dSDamien Bergamini 	if ((r = CSR_READ_4(sc, IWI_CSR_INTR)) == 0 || r == 0xffffffff) {
1422ceaec73dSDamien Bergamini 		IWI_UNLOCK(sc);
1423ceaec73dSDamien Bergamini 		return;
1424ceaec73dSDamien Bergamini 	}
1425ceaec73dSDamien Bergamini 
1426ceaec73dSDamien Bergamini 	/* disable interrupts */
1427ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_INTR_MASK, 0);
1428ceaec73dSDamien Bergamini 
1429ceaec73dSDamien Bergamini 	if (r & (IWI_INTR_FATAL_ERROR | IWI_INTR_PARITY_ERROR)) {
1430ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "fatal error\n");
1431ceaec73dSDamien Bergamini 		sc->sc_ic.ic_ifp->if_flags &= ~IFF_UP;
1432ceaec73dSDamien Bergamini 		iwi_stop(sc);
1433ceaec73dSDamien Bergamini 	}
1434ceaec73dSDamien Bergamini 
1435ceaec73dSDamien Bergamini 	if (r & IWI_INTR_FW_INITED) {
1436ceaec73dSDamien Bergamini 		if (!(r & (IWI_INTR_FATAL_ERROR | IWI_INTR_PARITY_ERROR)))
1437ceaec73dSDamien Bergamini 			wakeup(sc);
1438ceaec73dSDamien Bergamini 	}
1439ceaec73dSDamien Bergamini 
1440ceaec73dSDamien Bergamini 	if (r & IWI_INTR_RADIO_OFF) {
1441ceaec73dSDamien Bergamini 		DPRINTF(("radio transmitter turned off\n"));
1442ceaec73dSDamien Bergamini 		sc->sc_ic.ic_ifp->if_flags &= ~IFF_UP;
1443ceaec73dSDamien Bergamini 		iwi_stop(sc);
1444ceaec73dSDamien Bergamini 	}
1445ceaec73dSDamien Bergamini 
1446ceaec73dSDamien Bergamini 	if (r & IWI_INTR_CMD_DONE)
1447ceaec73dSDamien Bergamini 		wakeup(sc);
1448ceaec73dSDamien Bergamini 
1449ceaec73dSDamien Bergamini 	if (r & IWI_INTR_TX1_DONE)
1450ec01dc2bSDamien Bergamini 		iwi_tx_intr(sc, &sc->txq[0]);
1451ec01dc2bSDamien Bergamini 
1452ec01dc2bSDamien Bergamini 	if (r & IWI_INTR_TX2_DONE)
1453ec01dc2bSDamien Bergamini 		iwi_tx_intr(sc, &sc->txq[1]);
1454ec01dc2bSDamien Bergamini 
1455ec01dc2bSDamien Bergamini 	if (r & IWI_INTR_TX3_DONE)
1456ec01dc2bSDamien Bergamini 		iwi_tx_intr(sc, &sc->txq[2]);
1457ec01dc2bSDamien Bergamini 
1458ec01dc2bSDamien Bergamini 	if (r & IWI_INTR_TX4_DONE)
1459ec01dc2bSDamien Bergamini 		iwi_tx_intr(sc, &sc->txq[3]);
1460ec01dc2bSDamien Bergamini 
1461ec01dc2bSDamien Bergamini 	if (r & IWI_INTR_RX_DONE)
1462ec01dc2bSDamien Bergamini 		iwi_rx_intr(sc);
1463ceaec73dSDamien Bergamini 
1464ceaec73dSDamien Bergamini 	/* acknowledge interrupts */
1465ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_INTR, r);
1466ceaec73dSDamien Bergamini 
1467ceaec73dSDamien Bergamini 	/* re-enable interrupts */
1468ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_INTR_MASK, IWI_INTR_MASK);
1469ceaec73dSDamien Bergamini 
1470ceaec73dSDamien Bergamini 	IWI_UNLOCK(sc);
1471ceaec73dSDamien Bergamini }
1472ceaec73dSDamien Bergamini 
1473ceaec73dSDamien Bergamini static int
1474ceaec73dSDamien Bergamini iwi_cmd(struct iwi_softc *sc, uint8_t type, void *data, uint8_t len, int async)
1475ceaec73dSDamien Bergamini {
1476ceaec73dSDamien Bergamini 	struct iwi_cmd_desc *desc;
1477ceaec73dSDamien Bergamini 
1478ceaec73dSDamien Bergamini 	desc = &sc->cmdq.desc[sc->cmdq.cur];
1479ceaec73dSDamien Bergamini 
1480ceaec73dSDamien Bergamini 	desc->hdr.type = IWI_HDR_TYPE_COMMAND;
1481ceaec73dSDamien Bergamini 	desc->hdr.flags = IWI_HDR_FLAG_IRQ;
1482ceaec73dSDamien Bergamini 	desc->type = type;
1483ceaec73dSDamien Bergamini 	desc->len = len;
1484ceaec73dSDamien Bergamini 	memcpy(desc->data, data, len);
1485ceaec73dSDamien Bergamini 
1486ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->cmdq.desc_dmat, sc->cmdq.desc_map,
1487ceaec73dSDamien Bergamini 	    BUS_DMASYNC_PREWRITE);
1488ceaec73dSDamien Bergamini 
1489ceaec73dSDamien Bergamini 	DPRINTFN(2, ("sending command idx=%u type=%u len=%u\n", sc->cmdq.cur,
1490ceaec73dSDamien Bergamini 	    type, len));
1491ceaec73dSDamien Bergamini 
1492ceaec73dSDamien Bergamini 	sc->cmdq.cur = (sc->cmdq.cur + 1) % IWI_CMD_RING_COUNT;
1493ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CMD_WIDX, sc->cmdq.cur);
1494ceaec73dSDamien Bergamini 
1495ceaec73dSDamien Bergamini 	return async ? 0 : msleep(sc, &sc->sc_mtx, 0, "iwicmd", hz);
1496ceaec73dSDamien Bergamini }
1497ceaec73dSDamien Bergamini 
149828a38073SDamien Bergamini static void
149928a38073SDamien Bergamini iwi_write_ibssnode(struct iwi_softc *sc, const struct iwi_node *in)
150028a38073SDamien Bergamini {
150128a38073SDamien Bergamini 	struct iwi_ibssnode node;
150228a38073SDamien Bergamini 
150328a38073SDamien Bergamini 	/* write node information into NIC memory */
150428a38073SDamien Bergamini 	memset(&node, 0, sizeof node);
150528a38073SDamien Bergamini 	IEEE80211_ADDR_COPY(node.bssid, in->in_node.ni_macaddr);
150628a38073SDamien Bergamini 
150728a38073SDamien Bergamini 	CSR_WRITE_REGION_1(sc,
150828a38073SDamien Bergamini 	    IWI_CSR_NODE_BASE + in->in_station * sizeof node,
150928a38073SDamien Bergamini 	    (uint8_t *)&node, sizeof node);
151028a38073SDamien Bergamini }
151128a38073SDamien Bergamini 
1512ceaec73dSDamien Bergamini static int
15130b74a285SDamien Bergamini iwi_tx_start(struct ifnet *ifp, struct mbuf *m0, struct ieee80211_node *ni,
15140b74a285SDamien Bergamini     int ac)
1515ceaec73dSDamien Bergamini {
1516ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
1517ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
151828a38073SDamien Bergamini 	struct iwi_node *in = (struct iwi_node *)ni;
1519ec01dc2bSDamien Bergamini 	struct ieee80211_frame *wh;
1520acea4241SDamien Bergamini 	struct ieee80211_key *k;
1521ec01dc2bSDamien Bergamini 	const struct chanAccParams *cap;
15220b74a285SDamien Bergamini 	struct iwi_tx_ring *txq = &sc->txq[ac];
1523ceaec73dSDamien Bergamini 	struct iwi_tx_data *data;
1524ceaec73dSDamien Bergamini 	struct iwi_tx_desc *desc;
1525ceaec73dSDamien Bergamini 	struct mbuf *mnew;
1526ceaec73dSDamien Bergamini 	bus_dma_segment_t segs[IWI_MAX_NSEG];
152728a38073SDamien Bergamini 	int error, nsegs, hdrlen, i, noack = 0;
1528ceaec73dSDamien Bergamini 
1529ec01dc2bSDamien Bergamini 	wh = mtod(m0, struct ieee80211_frame *);
1530ec01dc2bSDamien Bergamini 
1531ec01dc2bSDamien Bergamini 	if (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_QOS) {
1532ec01dc2bSDamien Bergamini 		hdrlen = sizeof (struct ieee80211_qosframe);
1533ec01dc2bSDamien Bergamini 		cap = &ic->ic_wme.wme_chanParams;
1534ec01dc2bSDamien Bergamini 		noack = cap->cap_wmeParams[ac].wmep_noackPolicy;
15350b74a285SDamien Bergamini 	} else
1536ec01dc2bSDamien Bergamini 		hdrlen = sizeof (struct ieee80211_frame);
1537ec01dc2bSDamien Bergamini 
153828a38073SDamien Bergamini 	/*
153928a38073SDamien Bergamini 	 * This is only used in IBSS mode where the firmware expect an index
154028a38073SDamien Bergamini 	 * in a h/w table instead of a destination address.
154128a38073SDamien Bergamini 	 */
154228a38073SDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_IBSS && in->in_station == -1) {
154328a38073SDamien Bergamini 		in->in_station = alloc_unr(sc->sc_unr);
154428a38073SDamien Bergamini 		if (in->in_station == -1) {	/* h/w table is full */
1545ec01dc2bSDamien Bergamini 			m_freem(m0);
15460b74a285SDamien Bergamini 			ieee80211_free_node(ni);
15470b74a285SDamien Bergamini 			ifp->if_oerrors++;
1548ec01dc2bSDamien Bergamini 			return 0;
1549ec01dc2bSDamien Bergamini 		}
155028a38073SDamien Bergamini 		iwi_write_ibssnode(sc, in);
15510b74a285SDamien Bergamini 	}
1552ec01dc2bSDamien Bergamini 
1553ec01dc2bSDamien Bergamini 	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
1554acea4241SDamien Bergamini 		k = ieee80211_crypto_encap(ic, ni, m0);
155582145663SSam Leffler 		if (k == NULL) {
155682145663SSam Leffler 			m_freem(m0);
1557acea4241SDamien Bergamini 			return ENOBUFS;
1558acea4241SDamien Bergamini 		}
1559ec01dc2bSDamien Bergamini 
1560ec01dc2bSDamien Bergamini 		/* packet header may have moved, reset our local pointer */
1561ec01dc2bSDamien Bergamini 		wh = mtod(m0, struct ieee80211_frame *);
156282145663SSam Leffler 	}
1563acea4241SDamien Bergamini 
1564ceaec73dSDamien Bergamini 	if (sc->sc_drvbpf != NULL) {
1565ceaec73dSDamien Bergamini 		struct iwi_tx_radiotap_header *tap = &sc->sc_txtap;
1566ceaec73dSDamien Bergamini 
1567ceaec73dSDamien Bergamini 		tap->wt_flags = 0;
1568acea4241SDamien Bergamini 		tap->wt_chan_freq = htole16(ic->ic_ibss_chan->ic_freq);
1569acea4241SDamien Bergamini 		tap->wt_chan_flags = htole16(ic->ic_ibss_chan->ic_flags);
1570ceaec73dSDamien Bergamini 
1571ceaec73dSDamien Bergamini 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m0);
1572ceaec73dSDamien Bergamini 	}
1573ceaec73dSDamien Bergamini 
1574ec01dc2bSDamien Bergamini 	data = &txq->data[txq->cur];
1575ec01dc2bSDamien Bergamini 	desc = &txq->desc[txq->cur];
1576ceaec73dSDamien Bergamini 
1577ec01dc2bSDamien Bergamini 	/* save and trim IEEE802.11 header */
1578ec01dc2bSDamien Bergamini 	m_copydata(m0, 0, hdrlen, (caddr_t)&desc->wh);
1579ec01dc2bSDamien Bergamini 	m_adj(m0, hdrlen);
1580ceaec73dSDamien Bergamini 
1581ec01dc2bSDamien Bergamini 	error = bus_dmamap_load_mbuf_sg(txq->data_dmat, data->map, m0, segs,
1582ceaec73dSDamien Bergamini 	    &nsegs, 0);
1583ceaec73dSDamien Bergamini 	if (error != 0 && error != EFBIG) {
1584ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not map mbuf (error %d)\n",
1585ceaec73dSDamien Bergamini 		    error);
1586ceaec73dSDamien Bergamini 		m_freem(m0);
1587ceaec73dSDamien Bergamini 		return error;
1588ceaec73dSDamien Bergamini 	}
1589ceaec73dSDamien Bergamini 	if (error != 0) {
1590ceaec73dSDamien Bergamini 		mnew = m_defrag(m0, M_DONTWAIT);
1591ceaec73dSDamien Bergamini 		if (mnew == NULL) {
1592ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
1593ceaec73dSDamien Bergamini 			    "could not defragment mbuf\n");
1594ceaec73dSDamien Bergamini 			m_freem(m0);
1595ceaec73dSDamien Bergamini 			return ENOBUFS;
1596ceaec73dSDamien Bergamini 		}
1597ceaec73dSDamien Bergamini 		m0 = mnew;
1598ceaec73dSDamien Bergamini 
1599ec01dc2bSDamien Bergamini 		error = bus_dmamap_load_mbuf_sg(txq->data_dmat, data->map,
1600ceaec73dSDamien Bergamini 		    m0, segs, &nsegs, 0);
1601ceaec73dSDamien Bergamini 		if (error != 0) {
1602ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
1603ceaec73dSDamien Bergamini 			    "could not map mbuf (error %d)\n", error);
1604ceaec73dSDamien Bergamini 			m_freem(m0);
1605ceaec73dSDamien Bergamini 			return error;
1606ceaec73dSDamien Bergamini 		}
1607ceaec73dSDamien Bergamini 	}
1608ceaec73dSDamien Bergamini 
1609ceaec73dSDamien Bergamini 	data->m = m0;
1610ceaec73dSDamien Bergamini 	data->ni = ni;
1611ceaec73dSDamien Bergamini 
1612ceaec73dSDamien Bergamini 	desc->hdr.type = IWI_HDR_TYPE_DATA;
1613ceaec73dSDamien Bergamini 	desc->hdr.flags = IWI_HDR_FLAG_IRQ;
161428a38073SDamien Bergamini 	desc->station =
161528a38073SDamien Bergamini 	    (ic->ic_opmode == IEEE80211_M_IBSS) ? in->in_station : 0;
1616ceaec73dSDamien Bergamini 	desc->cmd = IWI_DATA_CMD_TX;
1617ceaec73dSDamien Bergamini 	desc->len = htole16(m0->m_pkthdr.len);
1618ceaec73dSDamien Bergamini 	desc->flags = 0;
1619ec01dc2bSDamien Bergamini 	desc->xflags = 0;
1620ceaec73dSDamien Bergamini 
1621ec01dc2bSDamien Bergamini 	if (!noack && !IEEE80211_IS_MULTICAST(desc->wh.i_addr1))
1622ceaec73dSDamien Bergamini 		desc->flags |= IWI_DATA_FLAG_NEED_ACK;
1623ceaec73dSDamien Bergamini 
1624acea4241SDamien Bergamini #if 0
1625ceaec73dSDamien Bergamini 	if (ic->ic_flags & IEEE80211_F_PRIVACY) {
1626ec01dc2bSDamien Bergamini 		desc->wh.i_fc[1] |= IEEE80211_FC1_WEP;
1627ceaec73dSDamien Bergamini 		desc->wep_txkey = ic->ic_crypto.cs_def_txkey;
1628ceaec73dSDamien Bergamini 	} else
1629acea4241SDamien Bergamini #endif
1630ceaec73dSDamien Bergamini 		desc->flags |= IWI_DATA_FLAG_NO_WEP;
1631ceaec73dSDamien Bergamini 
1632ceaec73dSDamien Bergamini 	if (ic->ic_flags & IEEE80211_F_SHPREAMBLE)
1633ceaec73dSDamien Bergamini 		desc->flags |= IWI_DATA_FLAG_SHPREAMBLE;
1634ceaec73dSDamien Bergamini 
1635ec01dc2bSDamien Bergamini 	if (desc->wh.i_fc[0] & IEEE80211_FC0_SUBTYPE_QOS)
1636ec01dc2bSDamien Bergamini 		desc->xflags |= IWI_DATA_XFLAG_QOS;
1637ec01dc2bSDamien Bergamini 
1638ceaec73dSDamien Bergamini 	desc->nseg = htole32(nsegs);
1639ceaec73dSDamien Bergamini 	for (i = 0; i < nsegs; i++) {
1640ceaec73dSDamien Bergamini 		desc->seg_addr[i] = htole32(segs[i].ds_addr);
164181e6343cSDamien Bergamini 		desc->seg_len[i]  = htole16(segs[i].ds_len);
1642ceaec73dSDamien Bergamini 	}
1643ceaec73dSDamien Bergamini 
1644ec01dc2bSDamien Bergamini 	bus_dmamap_sync(txq->data_dmat, data->map, BUS_DMASYNC_PREWRITE);
1645ec01dc2bSDamien Bergamini 	bus_dmamap_sync(txq->desc_dmat, txq->desc_map, BUS_DMASYNC_PREWRITE);
1646ceaec73dSDamien Bergamini 
1647ec01dc2bSDamien Bergamini 	DPRINTFN(5, ("sending data frame txq=%u idx=%u len=%u nseg=%u\n",
164881e6343cSDamien Bergamini 	    ac, txq->cur, le16toh(desc->len), nsegs));
1649ceaec73dSDamien Bergamini 
1650ec01dc2bSDamien Bergamini 	txq->queued++;
1651ec01dc2bSDamien Bergamini 	txq->cur = (txq->cur + 1) % IWI_TX_RING_COUNT;
1652ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, txq->csr_widx, txq->cur);
1653ceaec73dSDamien Bergamini 
1654ceaec73dSDamien Bergamini 	return 0;
1655ceaec73dSDamien Bergamini }
1656ceaec73dSDamien Bergamini 
1657ceaec73dSDamien Bergamini static void
1658ceaec73dSDamien Bergamini iwi_start(struct ifnet *ifp)
1659ceaec73dSDamien Bergamini {
1660ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
1661ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1662ceaec73dSDamien Bergamini 	struct mbuf *m0;
1663ceaec73dSDamien Bergamini 	struct ether_header *eh;
1664ceaec73dSDamien Bergamini 	struct ieee80211_node *ni;
16650b74a285SDamien Bergamini 	int ac;
1666ceaec73dSDamien Bergamini 
1667ceaec73dSDamien Bergamini 	IWI_LOCK(sc);
1668ceaec73dSDamien Bergamini 
1669ceaec73dSDamien Bergamini 	if (ic->ic_state != IEEE80211_S_RUN) {
1670ceaec73dSDamien Bergamini 		IWI_UNLOCK(sc);
1671ceaec73dSDamien Bergamini 		return;
1672ceaec73dSDamien Bergamini 	}
1673ceaec73dSDamien Bergamini 
1674ceaec73dSDamien Bergamini 	for (;;) {
1675ceaec73dSDamien Bergamini 		IFQ_DRV_DEQUEUE(&ifp->if_snd, m0);
1676ceaec73dSDamien Bergamini 		if (m0 == NULL)
1677ceaec73dSDamien Bergamini 			break;
1678ceaec73dSDamien Bergamini 
1679ceaec73dSDamien Bergamini 		if (m0->m_len < sizeof (struct ether_header) &&
16800b74a285SDamien Bergamini 		    (m0 = m_pullup(m0, sizeof (struct ether_header))) == NULL) {
16810b74a285SDamien Bergamini 			ifp->if_oerrors++;
1682ceaec73dSDamien Bergamini 			continue;
16830b74a285SDamien Bergamini 		}
1684ceaec73dSDamien Bergamini 		eh = mtod(m0, struct ether_header *);
1685ceaec73dSDamien Bergamini 		ni = ieee80211_find_txnode(ic, eh->ether_dhost);
1686ceaec73dSDamien Bergamini 		if (ni == NULL) {
1687ceaec73dSDamien Bergamini 			m_freem(m0);
16880b74a285SDamien Bergamini 			ifp->if_oerrors++;
1689ceaec73dSDamien Bergamini 			continue;
1690ceaec73dSDamien Bergamini 		}
16910b74a285SDamien Bergamini 
16920b74a285SDamien Bergamini 		/* classify mbuf so we can find which tx ring to use */
1693ec01dc2bSDamien Bergamini 		if (ieee80211_classify(ic, m0, ni) != 0) {
1694ec01dc2bSDamien Bergamini 			m_freem(m0);
16950b74a285SDamien Bergamini 			ieee80211_free_node(ni);
16960b74a285SDamien Bergamini 			ifp->if_oerrors++;
1697ec01dc2bSDamien Bergamini 			continue;
1698ec01dc2bSDamien Bergamini 		}
16990b74a285SDamien Bergamini 
17000b74a285SDamien Bergamini 		/* no QoS encapsulation for EAPOL frames */
17010b74a285SDamien Bergamini 		ac = (eh->ether_type != htons(ETHERTYPE_PAE)) ?
17020b74a285SDamien Bergamini 		    M_WME_GETAC(m0) : WME_AC_BE;
17030b74a285SDamien Bergamini 
17040b74a285SDamien Bergamini 		if (sc->txq[ac].queued > IWI_TX_RING_COUNT - 8) {
17050b74a285SDamien Bergamini 			/* there is no place left in this ring */
17060b74a285SDamien Bergamini 			IFQ_DRV_PREPEND(&ifp->if_snd, m0);
17070b74a285SDamien Bergamini 			ifp->if_drv_flags |= IFF_DRV_OACTIVE;
17080b74a285SDamien Bergamini 			break;
17090b74a285SDamien Bergamini 		}
17100b74a285SDamien Bergamini 
1711ceaec73dSDamien Bergamini 		BPF_MTAP(ifp, m0);
1712ceaec73dSDamien Bergamini 
1713ceaec73dSDamien Bergamini 		m0 = ieee80211_encap(ic, m0, ni);
17140a5ae7ccSSam Leffler 		if (m0 == NULL) {
17150a5ae7ccSSam Leffler 			ieee80211_free_node(ni);
17160b74a285SDamien Bergamini 			ifp->if_oerrors++;
1717ceaec73dSDamien Bergamini 			continue;
17180a5ae7ccSSam Leffler 		}
1719ceaec73dSDamien Bergamini 
1720ceaec73dSDamien Bergamini 		if (ic->ic_rawbpf != NULL)
1721ceaec73dSDamien Bergamini 			bpf_mtap(ic->ic_rawbpf, m0);
1722ceaec73dSDamien Bergamini 
17230b74a285SDamien Bergamini 		if (iwi_tx_start(ifp, m0, ni, ac) != 0) {
1724ceaec73dSDamien Bergamini 			ieee80211_free_node(ni);
1725ceaec73dSDamien Bergamini 			ifp->if_oerrors++;
1726ceaec73dSDamien Bergamini 			break;
1727ceaec73dSDamien Bergamini 		}
1728ceaec73dSDamien Bergamini 
1729ceaec73dSDamien Bergamini 		sc->sc_tx_timer = 5;
1730ceaec73dSDamien Bergamini 		ifp->if_timer = 1;
1731ceaec73dSDamien Bergamini 	}
1732ceaec73dSDamien Bergamini 
1733ceaec73dSDamien Bergamini 	IWI_UNLOCK(sc);
1734ceaec73dSDamien Bergamini }
1735ceaec73dSDamien Bergamini 
1736ceaec73dSDamien Bergamini static void
1737ceaec73dSDamien Bergamini iwi_watchdog(struct ifnet *ifp)
1738ceaec73dSDamien Bergamini {
1739ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
1740ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1741ceaec73dSDamien Bergamini 
1742ceaec73dSDamien Bergamini 	IWI_LOCK(sc);
1743ceaec73dSDamien Bergamini 
1744ceaec73dSDamien Bergamini 	ifp->if_timer = 0;
1745ceaec73dSDamien Bergamini 
1746ceaec73dSDamien Bergamini 	if (sc->sc_tx_timer > 0) {
1747ceaec73dSDamien Bergamini 		if (--sc->sc_tx_timer == 0) {
1748ceaec73dSDamien Bergamini 			if_printf(ifp, "device timeout\n");
1749ceaec73dSDamien Bergamini 			ifp->if_oerrors++;
1750ceaec73dSDamien Bergamini 			ifp->if_flags &= ~IFF_UP;
1751ceaec73dSDamien Bergamini 			iwi_stop(sc);
1752ceaec73dSDamien Bergamini 			IWI_UNLOCK(sc);
1753ceaec73dSDamien Bergamini 			return;
1754ceaec73dSDamien Bergamini 		}
1755ceaec73dSDamien Bergamini 		ifp->if_timer = 1;
1756ceaec73dSDamien Bergamini 	}
1757ceaec73dSDamien Bergamini 
1758ceaec73dSDamien Bergamini 	ieee80211_watchdog(ic);
1759ceaec73dSDamien Bergamini 
1760ceaec73dSDamien Bergamini 	IWI_UNLOCK(sc);
1761ceaec73dSDamien Bergamini }
1762ceaec73dSDamien Bergamini 
1763ceaec73dSDamien Bergamini static int
1764ceaec73dSDamien Bergamini iwi_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
1765ceaec73dSDamien Bergamini {
1766ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
1767ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1768ceaec73dSDamien Bergamini 	int error = 0;
1769ceaec73dSDamien Bergamini 
1770ceaec73dSDamien Bergamini 	IWI_LOCK(sc);
1771ceaec73dSDamien Bergamini 
1772ceaec73dSDamien Bergamini 	switch (cmd) {
1773ceaec73dSDamien Bergamini 	case SIOCSIFFLAGS:
1774ceaec73dSDamien Bergamini 		if (ifp->if_flags & IFF_UP) {
177513f4c340SRobert Watson 			if (!(ifp->if_drv_flags & IFF_DRV_RUNNING))
1776ceaec73dSDamien Bergamini 				iwi_init(sc);
1777ceaec73dSDamien Bergamini 		} else {
177813f4c340SRobert Watson 			if (ifp->if_drv_flags & IFF_DRV_RUNNING)
1779ceaec73dSDamien Bergamini 				iwi_stop(sc);
1780ceaec73dSDamien Bergamini 		}
1781ceaec73dSDamien Bergamini 		break;
1782ceaec73dSDamien Bergamini 
1783ceaec73dSDamien Bergamini 	default:
1784ceaec73dSDamien Bergamini 		error = ieee80211_ioctl(ic, cmd, data);
1785ceaec73dSDamien Bergamini 	}
1786ceaec73dSDamien Bergamini 
1787ceaec73dSDamien Bergamini 	if (error == ENETRESET) {
178813f4c340SRobert Watson 		if ((ifp->if_flags & IFF_UP) &&
1789e0454c26SDamien Bergamini 		    (ifp->if_drv_flags & IFF_DRV_RUNNING) &&
1790e0454c26SDamien Bergamini 		    (ic->ic_roaming != IEEE80211_ROAMING_MANUAL))
1791ceaec73dSDamien Bergamini 			iwi_init(sc);
1792ceaec73dSDamien Bergamini 		error = 0;
1793ceaec73dSDamien Bergamini 	}
1794ceaec73dSDamien Bergamini 
1795ceaec73dSDamien Bergamini 	IWI_UNLOCK(sc);
1796ceaec73dSDamien Bergamini 
1797ceaec73dSDamien Bergamini 	return error;
1798ceaec73dSDamien Bergamini }
1799ceaec73dSDamien Bergamini 
1800ceaec73dSDamien Bergamini static void
1801ceaec73dSDamien Bergamini iwi_stop_master(struct iwi_softc *sc)
1802ceaec73dSDamien Bergamini {
1803ceaec73dSDamien Bergamini 	uint32_t tmp;
1804ceaec73dSDamien Bergamini 	int ntries;
1805ceaec73dSDamien Bergamini 
1806ceaec73dSDamien Bergamini 	/* disable interrupts */
1807ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_INTR_MASK, 0);
1808ceaec73dSDamien Bergamini 
1809ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, IWI_RST_STOP_MASTER);
1810ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 5; ntries++) {
1811ceaec73dSDamien Bergamini 		if (CSR_READ_4(sc, IWI_CSR_RST) & IWI_RST_MASTER_DISABLED)
1812ceaec73dSDamien Bergamini 			break;
1813ceaec73dSDamien Bergamini 		DELAY(10);
1814ceaec73dSDamien Bergamini 	}
1815ceaec73dSDamien Bergamini 	if (ntries == 5)
1816ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "timeout waiting for master\n");
1817ceaec73dSDamien Bergamini 
1818ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_RST);
1819ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, tmp | IWI_RST_PRINCETON_RESET);
1820ceaec73dSDamien Bergamini 
1821ceaec73dSDamien Bergamini 	sc->flags &= ~IWI_FLAG_FW_INITED;
1822ceaec73dSDamien Bergamini }
1823ceaec73dSDamien Bergamini 
1824ceaec73dSDamien Bergamini static int
1825ceaec73dSDamien Bergamini iwi_reset(struct iwi_softc *sc)
1826ceaec73dSDamien Bergamini {
1827ceaec73dSDamien Bergamini 	uint32_t tmp;
1828ceaec73dSDamien Bergamini 	int i, ntries;
1829ceaec73dSDamien Bergamini 
1830ceaec73dSDamien Bergamini 	iwi_stop_master(sc);
1831ceaec73dSDamien Bergamini 
1832ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_CTL);
1833ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CTL, tmp | IWI_CTL_INIT);
1834ceaec73dSDamien Bergamini 
1835ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_READ_INT, IWI_READ_INT_INIT_HOST);
1836ceaec73dSDamien Bergamini 
1837ceaec73dSDamien Bergamini 	/* wait for clock stabilization */
1838ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 1000; ntries++) {
1839ceaec73dSDamien Bergamini 		if (CSR_READ_4(sc, IWI_CSR_CTL) & IWI_CTL_CLOCK_READY)
1840ceaec73dSDamien Bergamini 			break;
1841ceaec73dSDamien Bergamini 		DELAY(200);
1842ceaec73dSDamien Bergamini 	}
1843ceaec73dSDamien Bergamini 	if (ntries == 1000) {
1844ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
1845ceaec73dSDamien Bergamini 		    "timeout waiting for clock stabilization\n");
1846ceaec73dSDamien Bergamini 		return EIO;
1847ceaec73dSDamien Bergamini 	}
1848ceaec73dSDamien Bergamini 
1849ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_RST);
1850ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, tmp | IWI_RST_SOFT_RESET);
1851ceaec73dSDamien Bergamini 
1852ceaec73dSDamien Bergamini 	DELAY(10);
1853ceaec73dSDamien Bergamini 
1854ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_CTL);
1855ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CTL, tmp | IWI_CTL_INIT);
1856ceaec73dSDamien Bergamini 
1857ceaec73dSDamien Bergamini 	/* clear NIC memory */
1858ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_AUTOINC_ADDR, 0);
1859ceaec73dSDamien Bergamini 	for (i = 0; i < 0xc000; i++)
1860ceaec73dSDamien Bergamini 		CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, 0);
1861ceaec73dSDamien Bergamini 
1862ceaec73dSDamien Bergamini 	return 0;
1863ceaec73dSDamien Bergamini }
1864ceaec73dSDamien Bergamini 
1865ceaec73dSDamien Bergamini static int
1866408146edSDamien Bergamini iwi_load_ucode(struct iwi_softc *sc, const char *name)
1867ceaec73dSDamien Bergamini {
1868ceaec73dSDamien Bergamini 	uint32_t tmp;
1869ceaec73dSDamien Bergamini 	uint16_t *w;
1870408146edSDamien Bergamini 	char *uc;
1871408146edSDamien Bergamini 	int i, size, ntries, error;
1872408146edSDamien Bergamini 
1873408146edSDamien Bergamini 	IWI_UNLOCK(sc);
1874408146edSDamien Bergamini 	error = iwi_read_firmware(name, &uc, &size);
1875408146edSDamien Bergamini 	IWI_LOCK(sc);
1876408146edSDamien Bergamini 	if (error != 0) {
1877408146edSDamien Bergamini 		device_printf(sc->sc_dev, "could not read ucode image\n");
1878408146edSDamien Bergamini 		goto fail1;
1879408146edSDamien Bergamini 	}
1880408146edSDamien Bergamini 
1881408146edSDamien Bergamini 	if (size < sizeof (struct iwi_firmware_hdr)) {
1882408146edSDamien Bergamini 		error = EINVAL;
1883408146edSDamien Bergamini 		goto fail2;
1884408146edSDamien Bergamini 	}
1885408146edSDamien Bergamini 
1886408146edSDamien Bergamini 	uc += sizeof (struct iwi_firmware_hdr);
1887408146edSDamien Bergamini 	size -= sizeof (struct iwi_firmware_hdr);
1888ceaec73dSDamien Bergamini 
1889ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, CSR_READ_4(sc, IWI_CSR_RST) |
1890ceaec73dSDamien Bergamini 	    IWI_RST_STOP_MASTER);
1891ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 5; ntries++) {
1892ceaec73dSDamien Bergamini 		if (CSR_READ_4(sc, IWI_CSR_RST) & IWI_RST_MASTER_DISABLED)
1893ceaec73dSDamien Bergamini 			break;
1894ceaec73dSDamien Bergamini 		DELAY(10);
1895ceaec73dSDamien Bergamini 	}
1896ceaec73dSDamien Bergamini 	if (ntries == 5) {
1897ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "timeout waiting for master\n");
1898408146edSDamien Bergamini 		error = EIO;
1899408146edSDamien Bergamini 		goto fail2;
1900ceaec73dSDamien Bergamini 	}
1901ceaec73dSDamien Bergamini 
1902ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x3000e0, 0x80000000);
1903ceaec73dSDamien Bergamini 	DELAY(5000);
1904ceaec73dSDamien Bergamini 
1905ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_RST);
1906ceaec73dSDamien Bergamini 	tmp &= ~IWI_RST_PRINCETON_RESET;
1907ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, tmp);
1908ceaec73dSDamien Bergamini 
1909ceaec73dSDamien Bergamini 	DELAY(5000);
1910ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x3000e0, 0);
1911ceaec73dSDamien Bergamini 	DELAY(1000);
1912ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x300004, 1);
1913ceaec73dSDamien Bergamini 	DELAY(1000);
1914ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x300004, 0);
1915ceaec73dSDamien Bergamini 	DELAY(1000);
1916ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x200000, 0x00);
1917ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x200000, 0x40);
1918ceaec73dSDamien Bergamini 	DELAY(1000);
1919ceaec73dSDamien Bergamini 
1920ceaec73dSDamien Bergamini 	/* write microcode into adapter memory */
1921408146edSDamien Bergamini 	for (w = (uint16_t *)uc; size > 0; w++, size -= 2)
192281e6343cSDamien Bergamini 		MEM_WRITE_2(sc, 0x200010, htole16(*w));
1923ceaec73dSDamien Bergamini 
1924ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x200000, 0x00);
1925ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x200000, 0x80);
1926ceaec73dSDamien Bergamini 
1927ceaec73dSDamien Bergamini 	/* wait until we get an answer */
1928ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 100; ntries++) {
1929ceaec73dSDamien Bergamini 		if (MEM_READ_1(sc, 0x200000) & 1)
1930ceaec73dSDamien Bergamini 			break;
1931ceaec73dSDamien Bergamini 		DELAY(100);
1932ceaec73dSDamien Bergamini 	}
1933ceaec73dSDamien Bergamini 	if (ntries == 100) {
1934ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
1935ceaec73dSDamien Bergamini 		    "timeout waiting for ucode to initialize\n");
1936408146edSDamien Bergamini 		error = EIO;
1937408146edSDamien Bergamini 		goto fail2;
1938ceaec73dSDamien Bergamini 	}
1939ceaec73dSDamien Bergamini 
1940ceaec73dSDamien Bergamini 	/* read the answer or the firmware will not initialize properly */
1941ceaec73dSDamien Bergamini 	for (i = 0; i < 7; i++)
1942ceaec73dSDamien Bergamini 		MEM_READ_4(sc, 0x200004);
1943ceaec73dSDamien Bergamini 
1944ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x200000, 0x00);
1945ceaec73dSDamien Bergamini 
1946408146edSDamien Bergamini fail2:	free(uc, M_DEVBUF);
1947408146edSDamien Bergamini fail1:
1948408146edSDamien Bergamini 	return error;
1949ceaec73dSDamien Bergamini }
1950ceaec73dSDamien Bergamini 
1951ceaec73dSDamien Bergamini /* macro to handle unaligned little endian data in firmware image */
1952ceaec73dSDamien Bergamini #define GETLE32(p) ((p)[0] | (p)[1] << 8 | (p)[2] << 16 | (p)[3] << 24)
1953ceaec73dSDamien Bergamini 
1954ceaec73dSDamien Bergamini static int
1955408146edSDamien Bergamini iwi_load_firmware(struct iwi_softc *sc, const char *name)
1956ceaec73dSDamien Bergamini {
1957ceaec73dSDamien Bergamini 	bus_dma_tag_t dmat;
1958ceaec73dSDamien Bergamini 	bus_dmamap_t map;
1959ceaec73dSDamien Bergamini 	bus_addr_t physaddr;
1960ceaec73dSDamien Bergamini 	void *virtaddr;
1961408146edSDamien Bergamini 	char *fw;
1962ceaec73dSDamien Bergamini 	u_char *p, *end;
1963ceaec73dSDamien Bergamini 	uint32_t sentinel, ctl, src, dst, sum, len, mlen, tmp;
1964408146edSDamien Bergamini 	int size, ntries, error;
1965408146edSDamien Bergamini 
1966408146edSDamien Bergamini 	/* read firmware image from filesystem */
1967408146edSDamien Bergamini 	IWI_UNLOCK(sc);
1968408146edSDamien Bergamini 	error = iwi_read_firmware(name, &fw, &size);
1969408146edSDamien Bergamini 	IWI_LOCK(sc);
1970408146edSDamien Bergamini 	if (error != 0) {
1971408146edSDamien Bergamini 		device_printf(sc->sc_dev, "could not read firmware image\n");
1972408146edSDamien Bergamini 		goto fail1;
1973408146edSDamien Bergamini 	}
1974408146edSDamien Bergamini 
1975408146edSDamien Bergamini 	if (size < sizeof (struct iwi_firmware_hdr)) {
1976408146edSDamien Bergamini 		error = EINVAL;
1977408146edSDamien Bergamini 		goto fail2;
1978408146edSDamien Bergamini 	}
1979408146edSDamien Bergamini 
1980408146edSDamien Bergamini 	fw += sizeof (struct iwi_firmware_hdr);
1981408146edSDamien Bergamini 	size -= sizeof (struct iwi_firmware_hdr);
1982ceaec73dSDamien Bergamini 
1983ceaec73dSDamien Bergamini 	/* allocate DMA memory for mapping firmware image */
1984ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
1985ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, size, 1, size, 0, NULL, NULL, &dmat);
1986ceaec73dSDamien Bergamini 	if (error != 0) {
1987ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
1988ceaec73dSDamien Bergamini 		    "could not create firmware DMA tag\n");
1989408146edSDamien Bergamini 		goto fail2;
1990ceaec73dSDamien Bergamini 	}
1991ceaec73dSDamien Bergamini 
1992ceaec73dSDamien Bergamini 	error = bus_dmamem_alloc(dmat, &virtaddr, BUS_DMA_NOWAIT, &map);
1993ceaec73dSDamien Bergamini 	if (error != 0) {
1994ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
1995ceaec73dSDamien Bergamini 		    "could not allocate firmware DMA memory\n");
1996408146edSDamien Bergamini 		goto fail3;
1997ceaec73dSDamien Bergamini 	}
1998ceaec73dSDamien Bergamini 
1999ceaec73dSDamien Bergamini 	error = bus_dmamap_load(dmat, map, virtaddr, size, iwi_dma_map_addr,
2000ceaec73dSDamien Bergamini 	    &physaddr, 0);
2001ceaec73dSDamien Bergamini 	if (error != 0) {
2002ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load firmware DMA map\n");
2003408146edSDamien Bergamini 		goto fail4;
2004ceaec73dSDamien Bergamini 	}
2005ceaec73dSDamien Bergamini 
2006ceaec73dSDamien Bergamini 	/* copy firmware image to DMA memory */
2007ceaec73dSDamien Bergamini 	memcpy(virtaddr, fw, size);
2008ceaec73dSDamien Bergamini 
2009ceaec73dSDamien Bergamini 	/* make sure the adapter will get up-to-date values */
2010ceaec73dSDamien Bergamini 	bus_dmamap_sync(dmat, map, BUS_DMASYNC_PREWRITE);
2011ceaec73dSDamien Bergamini 
2012ceaec73dSDamien Bergamini 	/* tell the adapter where the command blocks are stored */
2013ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x3000a0, 0x27000);
2014ceaec73dSDamien Bergamini 
2015ceaec73dSDamien Bergamini 	/*
2016ceaec73dSDamien Bergamini 	 * Store command blocks into adapter's internal memory using register
2017ceaec73dSDamien Bergamini 	 * indirections. The adapter will read the firmware image through DMA
2018ceaec73dSDamien Bergamini 	 * using information stored in command blocks.
2019ceaec73dSDamien Bergamini 	 */
2020ceaec73dSDamien Bergamini 	src = physaddr;
2021ceaec73dSDamien Bergamini 	p = virtaddr;
2022ceaec73dSDamien Bergamini 	end = p + size;
2023ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_AUTOINC_ADDR, 0x27000);
2024ceaec73dSDamien Bergamini 
2025ceaec73dSDamien Bergamini 	while (p < end) {
2026ceaec73dSDamien Bergamini 		dst = GETLE32(p); p += 4; src += 4;
2027ceaec73dSDamien Bergamini 		len = GETLE32(p); p += 4; src += 4;
2028ceaec73dSDamien Bergamini 		p += len;
2029ceaec73dSDamien Bergamini 
2030ceaec73dSDamien Bergamini 		while (len > 0) {
2031ceaec73dSDamien Bergamini 			mlen = min(len, IWI_CB_MAXDATALEN);
2032ceaec73dSDamien Bergamini 
2033ceaec73dSDamien Bergamini 			ctl = IWI_CB_DEFAULT_CTL | mlen;
2034ceaec73dSDamien Bergamini 			sum = ctl ^ src ^ dst;
2035ceaec73dSDamien Bergamini 
2036ceaec73dSDamien Bergamini 			/* write a command block */
2037ceaec73dSDamien Bergamini 			CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, ctl);
2038ceaec73dSDamien Bergamini 			CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, src);
2039ceaec73dSDamien Bergamini 			CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, dst);
2040ceaec73dSDamien Bergamini 			CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, sum);
2041ceaec73dSDamien Bergamini 
2042ceaec73dSDamien Bergamini 			src += mlen;
2043ceaec73dSDamien Bergamini 			dst += mlen;
2044ceaec73dSDamien Bergamini 			len -= mlen;
2045ceaec73dSDamien Bergamini 		}
2046ceaec73dSDamien Bergamini 	}
2047ceaec73dSDamien Bergamini 
2048ceaec73dSDamien Bergamini 	/* write a fictive final command block (sentinel) */
2049ceaec73dSDamien Bergamini 	sentinel = CSR_READ_4(sc, IWI_CSR_AUTOINC_ADDR);
2050ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, 0);
2051ceaec73dSDamien Bergamini 
2052ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_RST);
2053ceaec73dSDamien Bergamini 	tmp &= ~(IWI_RST_MASTER_DISABLED | IWI_RST_STOP_MASTER);
2054ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, tmp);
2055ceaec73dSDamien Bergamini 
2056ceaec73dSDamien Bergamini 	/* tell the adapter to start processing command blocks */
2057ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x3000a4, 0x540100);
2058ceaec73dSDamien Bergamini 
2059408146edSDamien Bergamini 	/* wait until the adapter reaches the sentinel */
2060ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 400; ntries++) {
2061ceaec73dSDamien Bergamini 		if (MEM_READ_4(sc, 0x3000d0) >= sentinel)
2062ceaec73dSDamien Bergamini 			break;
2063ceaec73dSDamien Bergamini 		DELAY(100);
2064ceaec73dSDamien Bergamini 	}
2065ceaec73dSDamien Bergamini 	if (ntries == 400) {
2066ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
2067ceaec73dSDamien Bergamini 		    "timeout processing command blocks\n");
2068ceaec73dSDamien Bergamini 		error = EIO;
2069408146edSDamien Bergamini 		goto fail5;
2070ceaec73dSDamien Bergamini 	}
2071ceaec73dSDamien Bergamini 
2072ceaec73dSDamien Bergamini 	/* we're done with command blocks processing */
2073ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x3000a4, 0x540c00);
2074ceaec73dSDamien Bergamini 
2075408146edSDamien Bergamini 	/* allow interrupts so we know when the firmware is ready */
2076ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_INTR_MASK, IWI_INTR_MASK);
2077ceaec73dSDamien Bergamini 
2078ceaec73dSDamien Bergamini 	/* tell the adapter to initialize the firmware */
2079ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, 0);
2080ceaec73dSDamien Bergamini 
2081ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_CTL);
2082ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CTL, tmp | IWI_CTL_ALLOW_STANDBY);
2083ceaec73dSDamien Bergamini 
2084ceaec73dSDamien Bergamini 	/* wait at most one second for firmware initialization to complete */
2085ceaec73dSDamien Bergamini 	if ((error = msleep(sc, &sc->sc_mtx, 0, "iwiinit", hz)) != 0) {
2086ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "timeout waiting for firmware "
2087ceaec73dSDamien Bergamini 		    "initialization to complete\n");
2088ceaec73dSDamien Bergamini 	}
2089ceaec73dSDamien Bergamini 
2090408146edSDamien Bergamini fail5:	bus_dmamap_sync(dmat, map, BUS_DMASYNC_POSTWRITE);
2091ceaec73dSDamien Bergamini 	bus_dmamap_unload(dmat, map);
2092408146edSDamien Bergamini fail4:	bus_dmamem_free(dmat, virtaddr, map);
2093408146edSDamien Bergamini fail3:	bus_dma_tag_destroy(dmat);
2094408146edSDamien Bergamini fail2:	free(fw, M_DEVBUF);
2095ceaec73dSDamien Bergamini fail1:
2096ceaec73dSDamien Bergamini 	return error;
2097ceaec73dSDamien Bergamini }
2098ceaec73dSDamien Bergamini 
2099ceaec73dSDamien Bergamini static int
2100ceaec73dSDamien Bergamini iwi_config(struct iwi_softc *sc)
2101ceaec73dSDamien Bergamini {
2102ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2103ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
2104ceaec73dSDamien Bergamini 	struct iwi_configuration config;
2105ceaec73dSDamien Bergamini 	struct iwi_rateset rs;
2106ceaec73dSDamien Bergamini 	struct iwi_txpower power;
2107ceaec73dSDamien Bergamini 	struct ieee80211_key *wk;
2108ceaec73dSDamien Bergamini 	struct iwi_wep_key wepkey;
2109ceaec73dSDamien Bergamini 	uint32_t data;
2110ceaec73dSDamien Bergamini 	int error, i;
2111ceaec73dSDamien Bergamini 
2112ceaec73dSDamien Bergamini 	IEEE80211_ADDR_COPY(ic->ic_myaddr, IF_LLADDR(ifp));
2113ceaec73dSDamien Bergamini 	DPRINTF(("Setting MAC address to %6D\n", ic->ic_myaddr, ":"));
2114ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_MAC_ADDRESS, ic->ic_myaddr,
2115ceaec73dSDamien Bergamini 	    IEEE80211_ADDR_LEN, 0);
2116ceaec73dSDamien Bergamini 	if (error != 0)
2117ceaec73dSDamien Bergamini 		return error;
2118ceaec73dSDamien Bergamini 
2119ceaec73dSDamien Bergamini 	memset(&config, 0, sizeof config);
2120ceaec73dSDamien Bergamini 	config.bluetooth_coexistence = sc->bluetooth;
2121acea4241SDamien Bergamini 	config.antenna = sc->antenna;
2122ceaec73dSDamien Bergamini 	config.multicast_enabled = 1;
2123acea4241SDamien Bergamini 	config.answer_pbreq = (ic->ic_opmode == IEEE80211_M_IBSS) ? 1 : 0;
2124acea4241SDamien Bergamini 	config.disable_unicast_decryption = 1;
2125acea4241SDamien Bergamini 	config.disable_multicast_decryption = 1;
2126ceaec73dSDamien Bergamini 	DPRINTF(("Configuring adapter\n"));
2127ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_CONFIG, &config, sizeof config, 0);
2128ceaec73dSDamien Bergamini 	if (error != 0)
2129ceaec73dSDamien Bergamini 		return error;
2130ceaec73dSDamien Bergamini 
2131ceaec73dSDamien Bergamini 	data = htole32(IWI_POWER_MODE_CAM);
2132ceaec73dSDamien Bergamini 	DPRINTF(("Setting power mode to %u\n", le32toh(data)));
2133ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_POWER_MODE, &data, sizeof data, 0);
2134ceaec73dSDamien Bergamini 	if (error != 0)
2135ceaec73dSDamien Bergamini 		return error;
2136ceaec73dSDamien Bergamini 
2137ceaec73dSDamien Bergamini 	data = htole32(ic->ic_rtsthreshold);
2138ceaec73dSDamien Bergamini 	DPRINTF(("Setting RTS threshold to %u\n", le32toh(data)));
2139ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_RTS_THRESHOLD, &data, sizeof data, 0);
2140ceaec73dSDamien Bergamini 	if (error != 0)
2141ceaec73dSDamien Bergamini 		return error;
2142ceaec73dSDamien Bergamini 
2143acea4241SDamien Bergamini 	data = htole32(ic->ic_fragthreshold);
2144acea4241SDamien Bergamini 	DPRINTF(("Setting fragmentation threshold to %u\n", le32toh(data)));
2145acea4241SDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_FRAG_THRESHOLD, &data, sizeof data, 0);
2146acea4241SDamien Bergamini 	if (error != 0)
2147acea4241SDamien Bergamini 		return error;
2148acea4241SDamien Bergamini 
2149ceaec73dSDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_IBSS) {
2150ceaec73dSDamien Bergamini 		power.mode = IWI_MODE_11B;
2151ceaec73dSDamien Bergamini 		power.nchan = 11;
2152ceaec73dSDamien Bergamini 		for (i = 0; i < 11; i++) {
2153ceaec73dSDamien Bergamini 			power.chan[i].chan = i + 1;
2154ceaec73dSDamien Bergamini 			power.chan[i].power = IWI_TXPOWER_MAX;
2155ceaec73dSDamien Bergamini 		}
2156ceaec73dSDamien Bergamini 		DPRINTF(("Setting .11b channels tx power\n"));
2157ceaec73dSDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_TX_POWER, &power, sizeof power,
2158ceaec73dSDamien Bergamini 		    0);
2159ceaec73dSDamien Bergamini 		if (error != 0)
2160ceaec73dSDamien Bergamini 			return error;
2161ceaec73dSDamien Bergamini 
2162ceaec73dSDamien Bergamini 		power.mode = IWI_MODE_11G;
2163ceaec73dSDamien Bergamini 		DPRINTF(("Setting .11g channels tx power\n"));
2164ceaec73dSDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_TX_POWER, &power, sizeof power,
2165ceaec73dSDamien Bergamini 		    0);
2166ceaec73dSDamien Bergamini 		if (error != 0)
2167ceaec73dSDamien Bergamini 			return error;
2168ceaec73dSDamien Bergamini 	}
2169ceaec73dSDamien Bergamini 
2170ceaec73dSDamien Bergamini 	rs.mode = IWI_MODE_11G;
2171ceaec73dSDamien Bergamini 	rs.type = IWI_RATESET_TYPE_SUPPORTED;
2172ceaec73dSDamien Bergamini 	rs.nrates = ic->ic_sup_rates[IEEE80211_MODE_11G].rs_nrates;
2173ceaec73dSDamien Bergamini 	memcpy(rs.rates, ic->ic_sup_rates[IEEE80211_MODE_11G].rs_rates,
2174ceaec73dSDamien Bergamini 	    rs.nrates);
2175ceaec73dSDamien Bergamini 	DPRINTF(("Setting .11bg supported rates (%u)\n", rs.nrates));
2176ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_RATES, &rs, sizeof rs, 0);
2177ceaec73dSDamien Bergamini 	if (error != 0)
2178ceaec73dSDamien Bergamini 		return error;
2179ceaec73dSDamien Bergamini 
2180ceaec73dSDamien Bergamini 	rs.mode = IWI_MODE_11A;
2181ceaec73dSDamien Bergamini 	rs.type = IWI_RATESET_TYPE_SUPPORTED;
2182ceaec73dSDamien Bergamini 	rs.nrates = ic->ic_sup_rates[IEEE80211_MODE_11A].rs_nrates;
2183ceaec73dSDamien Bergamini 	memcpy(rs.rates, ic->ic_sup_rates[IEEE80211_MODE_11A].rs_rates,
2184ceaec73dSDamien Bergamini 	    rs.nrates);
2185ceaec73dSDamien Bergamini 	DPRINTF(("Setting .11a supported rates (%u)\n", rs.nrates));
2186ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_RATES, &rs, sizeof rs, 0);
2187ceaec73dSDamien Bergamini 	if (error != 0)
2188ceaec73dSDamien Bergamini 		return error;
2189ceaec73dSDamien Bergamini 
21900b74a285SDamien Bergamini 	/* if we have a desired ESSID, set it now */
21910b74a285SDamien Bergamini 	if (ic->ic_des_esslen != 0) {
21920b74a285SDamien Bergamini #ifdef IWI_DEBUG
21930b74a285SDamien Bergamini 		if (iwi_debug > 0) {
21940b74a285SDamien Bergamini 			printf("Setting desired ESSID to ");
21950b74a285SDamien Bergamini 			ieee80211_print_essid(ic->ic_des_essid,
21960b74a285SDamien Bergamini 			    ic->ic_des_esslen);
21970b74a285SDamien Bergamini 			printf("\n");
21980b74a285SDamien Bergamini 		}
21990b74a285SDamien Bergamini #endif
22000b74a285SDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_ESSID, ic->ic_des_essid,
22017e47fb02SDamien Bergamini 		    ic->ic_des_esslen, 0);
22020b74a285SDamien Bergamini 		if (error != 0)
22030b74a285SDamien Bergamini 			return error;
22040b74a285SDamien Bergamini 	}
22050b74a285SDamien Bergamini 
2206ceaec73dSDamien Bergamini 	data = htole32(arc4random());
2207ceaec73dSDamien Bergamini 	DPRINTF(("Setting initialization vector to %u\n", le32toh(data)));
2208ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_IV, &data, sizeof data, 0);
2209ceaec73dSDamien Bergamini 	if (error != 0)
2210ceaec73dSDamien Bergamini 		return error;
2211ceaec73dSDamien Bergamini 
2212ceaec73dSDamien Bergamini 	for (i = 0; i < IEEE80211_WEP_NKID; i++) {
2213ceaec73dSDamien Bergamini 		wk = &ic->ic_crypto.cs_nw_keys[i];
2214ceaec73dSDamien Bergamini 
2215ceaec73dSDamien Bergamini 		wepkey.cmd = IWI_WEP_KEY_CMD_SETKEY;
2216ceaec73dSDamien Bergamini 		wepkey.idx = i;
2217ceaec73dSDamien Bergamini 		wepkey.len = wk->wk_keylen;
2218ceaec73dSDamien Bergamini 		memset(wepkey.key, 0, sizeof wepkey.key);
2219ceaec73dSDamien Bergamini 		memcpy(wepkey.key, wk->wk_key, wk->wk_keylen);
2220ceaec73dSDamien Bergamini 		DPRINTF(("Setting wep key index %u len %u\n", wepkey.idx,
2221ceaec73dSDamien Bergamini 		    wepkey.len));
2222ceaec73dSDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_WEP_KEY, &wepkey,
2223ceaec73dSDamien Bergamini 		    sizeof wepkey, 0);
2224ceaec73dSDamien Bergamini 		if (error != 0)
2225ceaec73dSDamien Bergamini 			return error;
2226ceaec73dSDamien Bergamini 	}
2227ceaec73dSDamien Bergamini 
2228ceaec73dSDamien Bergamini 	/* enable adapter */
2229ceaec73dSDamien Bergamini 	DPRINTF(("Enabling adapter\n"));
2230ceaec73dSDamien Bergamini 	return iwi_cmd(sc, IWI_CMD_ENABLE, NULL, 0, 0);
2231ceaec73dSDamien Bergamini }
2232ceaec73dSDamien Bergamini 
2233ceaec73dSDamien Bergamini static int
2234acea4241SDamien Bergamini iwi_set_chan(struct iwi_softc *sc, struct ieee80211_channel *chan)
2235acea4241SDamien Bergamini {
2236acea4241SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2237acea4241SDamien Bergamini 	struct iwi_scan scan;
2238acea4241SDamien Bergamini 
2239acea4241SDamien Bergamini 	memset(&scan, 0, sizeof scan);
224071016a24SDamien Bergamini 	memset(scan.type, IWI_SCAN_TYPE_PASSIVE, sizeof scan.type);
224180e1a712SDamien Bergamini 	scan.passive = htole16(2000);
224280e1a712SDamien Bergamini 	scan.channels[0] = 1 |
224380e1a712SDamien Bergamini 	    (IEEE80211_IS_CHAN_5GHZ(chan) ? IWI_CHAN_5GHZ : IWI_CHAN_2GHZ);
2244acea4241SDamien Bergamini 	scan.channels[1] = ieee80211_chan2ieee(ic, chan);
2245acea4241SDamien Bergamini 
2246acea4241SDamien Bergamini 	DPRINTF(("Setting channel to %u\n", ieee80211_chan2ieee(ic, chan)));
2247acea4241SDamien Bergamini 	return iwi_cmd(sc, IWI_CMD_SCAN, &scan, sizeof scan, 1);
2248acea4241SDamien Bergamini }
2249acea4241SDamien Bergamini 
2250acea4241SDamien Bergamini static int
2251ceaec73dSDamien Bergamini iwi_scan(struct iwi_softc *sc)
2252ceaec73dSDamien Bergamini {
2253ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2254ceaec73dSDamien Bergamini 	struct iwi_scan scan;
2255ceaec73dSDamien Bergamini 	uint8_t *p;
2256ceaec73dSDamien Bergamini 	int i, count;
2257ceaec73dSDamien Bergamini 
2258ceaec73dSDamien Bergamini 	memset(&scan, 0, sizeof scan);
225980e1a712SDamien Bergamini 
226080e1a712SDamien Bergamini 	if (ic->ic_des_esslen != 0) {
226180e1a712SDamien Bergamini 		scan.bdirected = htole16(sc->dwelltime);
226271016a24SDamien Bergamini 		memset(scan.type, IWI_SCAN_TYPE_BDIRECTED, sizeof scan.type);
226380e1a712SDamien Bergamini 	} else {
226480e1a712SDamien Bergamini 		scan.broadcast = htole16(sc->dwelltime);
226571016a24SDamien Bergamini 		memset(scan.type, IWI_SCAN_TYPE_BROADCAST, sizeof scan.type);
226680e1a712SDamien Bergamini 	}
2267ceaec73dSDamien Bergamini 
2268ceaec73dSDamien Bergamini 	p = scan.channels;
2269ceaec73dSDamien Bergamini 	count = 0;
2270ceaec73dSDamien Bergamini 	for (i = 0; i <= IEEE80211_CHAN_MAX; i++) {
2271ceaec73dSDamien Bergamini 		if (IEEE80211_IS_CHAN_5GHZ(&ic->ic_channels[i]) &&
2272ceaec73dSDamien Bergamini 		    isset(ic->ic_chan_active, i)) {
2273ceaec73dSDamien Bergamini 			*++p = i;
2274ceaec73dSDamien Bergamini 			count++;
2275ceaec73dSDamien Bergamini 		}
2276ceaec73dSDamien Bergamini 	}
2277ceaec73dSDamien Bergamini 	*(p - count) = IWI_CHAN_5GHZ | count;
2278ceaec73dSDamien Bergamini 
2279ceaec73dSDamien Bergamini 	count = 0;
2280ceaec73dSDamien Bergamini 	for (i = 0; i <= IEEE80211_CHAN_MAX; i++) {
2281ceaec73dSDamien Bergamini 		if (IEEE80211_IS_CHAN_2GHZ(&ic->ic_channels[i]) &&
2282ceaec73dSDamien Bergamini 		    isset(ic->ic_chan_active, i)) {
2283ceaec73dSDamien Bergamini 			*++p = i;
2284ceaec73dSDamien Bergamini 			count++;
2285ceaec73dSDamien Bergamini 		}
2286ceaec73dSDamien Bergamini 	}
2287ceaec73dSDamien Bergamini 	*(p - count) = IWI_CHAN_2GHZ | count;
2288ceaec73dSDamien Bergamini 
2289ceaec73dSDamien Bergamini 	DPRINTF(("Start scanning\n"));
2290ceaec73dSDamien Bergamini 	return iwi_cmd(sc, IWI_CMD_SCAN, &scan, sizeof scan, 1);
2291ceaec73dSDamien Bergamini }
2292ceaec73dSDamien Bergamini 
2293ceaec73dSDamien Bergamini static int
2294ceaec73dSDamien Bergamini iwi_auth_and_assoc(struct iwi_softc *sc)
2295ceaec73dSDamien Bergamini {
2296ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2297ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
2298ceaec73dSDamien Bergamini 	struct ieee80211_node *ni = ic->ic_bss;
2299ec01dc2bSDamien Bergamini 	struct ieee80211_wme_info wme;
2300ceaec73dSDamien Bergamini 	struct iwi_configuration config;
2301ceaec73dSDamien Bergamini 	struct iwi_associate assoc;
2302ceaec73dSDamien Bergamini 	struct iwi_rateset rs;
2303acea4241SDamien Bergamini 	uint16_t capinfo;
2304ceaec73dSDamien Bergamini 	uint32_t data;
2305ceaec73dSDamien Bergamini 	int error;
2306ceaec73dSDamien Bergamini 
2307ceaec73dSDamien Bergamini 	if (IEEE80211_IS_CHAN_2GHZ(ni->ni_chan)) {
2308ceaec73dSDamien Bergamini 		memset(&config, 0, sizeof config);
2309ceaec73dSDamien Bergamini 		config.bluetooth_coexistence = sc->bluetooth;
2310acea4241SDamien Bergamini 		config.antenna = sc->antenna;
2311ceaec73dSDamien Bergamini 		config.multicast_enabled = 1;
2312ceaec73dSDamien Bergamini 		config.use_protection = 1;
2313acea4241SDamien Bergamini 		config.answer_pbreq =
2314acea4241SDamien Bergamini 		    (ic->ic_opmode == IEEE80211_M_IBSS) ? 1 : 0;
2315acea4241SDamien Bergamini 		config.disable_unicast_decryption = 1;
2316acea4241SDamien Bergamini 		config.disable_multicast_decryption = 1;
2317ceaec73dSDamien Bergamini 		DPRINTF(("Configuring adapter\n"));
2318ceaec73dSDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_CONFIG, &config, sizeof config,
2319ceaec73dSDamien Bergamini 		    1);
2320ceaec73dSDamien Bergamini 		if (error != 0)
2321ceaec73dSDamien Bergamini 			return error;
2322ceaec73dSDamien Bergamini 	}
2323ceaec73dSDamien Bergamini 
2324ceaec73dSDamien Bergamini #ifdef IWI_DEBUG
2325ceaec73dSDamien Bergamini 	if (iwi_debug > 0) {
2326ceaec73dSDamien Bergamini 		printf("Setting ESSID to ");
2327ceaec73dSDamien Bergamini 		ieee80211_print_essid(ni->ni_essid, ni->ni_esslen);
2328ceaec73dSDamien Bergamini 		printf("\n");
2329ceaec73dSDamien Bergamini 	}
2330ceaec73dSDamien Bergamini #endif
2331ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_ESSID, ni->ni_essid, ni->ni_esslen, 1);
2332ceaec73dSDamien Bergamini 	if (error != 0)
2333ceaec73dSDamien Bergamini 		return error;
2334ceaec73dSDamien Bergamini 
233580e1a712SDamien Bergamini 	/* the rate set has already been "negotiated" */
2336ceaec73dSDamien Bergamini 	rs.mode = IEEE80211_IS_CHAN_5GHZ(ni->ni_chan) ? IWI_MODE_11A :
2337ceaec73dSDamien Bergamini 	    IWI_MODE_11G;
233880e1a712SDamien Bergamini 	rs.type = IWI_RATESET_TYPE_NEGOTIATED;
2339ceaec73dSDamien Bergamini 	rs.nrates = ni->ni_rates.rs_nrates;
2340ceaec73dSDamien Bergamini 	memcpy(rs.rates, ni->ni_rates.rs_rates, rs.nrates);
2341ceaec73dSDamien Bergamini 	DPRINTF(("Setting negociated rates (%u)\n", rs.nrates));
2342ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_RATES, &rs, sizeof rs, 1);
2343ceaec73dSDamien Bergamini 	if (error != 0)
2344ceaec73dSDamien Bergamini 		return error;
2345ceaec73dSDamien Bergamini 
2346ec01dc2bSDamien Bergamini 	if ((ic->ic_flags & IEEE80211_F_WME) && ni->ni_wme_ie != NULL) {
2347ec01dc2bSDamien Bergamini 		wme.wme_id = IEEE80211_ELEMID_VENDOR;
2348ec01dc2bSDamien Bergamini 		wme.wme_len = sizeof (struct ieee80211_wme_info) - 2;
2349ec01dc2bSDamien Bergamini 		wme.wme_oui[0] = 0x00;
2350ec01dc2bSDamien Bergamini 		wme.wme_oui[1] = 0x50;
2351ec01dc2bSDamien Bergamini 		wme.wme_oui[2] = 0xf2;
2352ec01dc2bSDamien Bergamini 		wme.wme_type = WME_OUI_TYPE;
2353ec01dc2bSDamien Bergamini 		wme.wme_subtype = WME_INFO_OUI_SUBTYPE;
2354ec01dc2bSDamien Bergamini 		wme.wme_version = WME_VERSION;
2355ec01dc2bSDamien Bergamini 		wme.wme_info = 0;
2356ec01dc2bSDamien Bergamini 
2357ec01dc2bSDamien Bergamini 		DPRINTF(("Setting WME IE (len=%u)\n", wme.wme_len));
2358ec01dc2bSDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_WMEIE, &wme, sizeof wme, 1);
2359ec01dc2bSDamien Bergamini 		if (error != 0)
2360ec01dc2bSDamien Bergamini 			return error;
2361ec01dc2bSDamien Bergamini 	}
2362ec01dc2bSDamien Bergamini 
2363acea4241SDamien Bergamini 	if (ic->ic_opt_ie != NULL) {
2364acea4241SDamien Bergamini 		DPRINTF(("Setting optional IE (len=%u)\n", ic->ic_opt_ie_len));
2365acea4241SDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_OPTIE, ic->ic_opt_ie,
2366acea4241SDamien Bergamini 		    ic->ic_opt_ie_len, 1);
2367acea4241SDamien Bergamini 		if (error != 0)
2368acea4241SDamien Bergamini 			return error;
2369acea4241SDamien Bergamini 	}
2370acea4241SDamien Bergamini 
2371ceaec73dSDamien Bergamini 	data = htole32(ni->ni_rssi);
2372ceaec73dSDamien Bergamini 	DPRINTF(("Setting sensitivity to %d\n", (int8_t)ni->ni_rssi));
2373ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_SENSITIVITY, &data, sizeof data, 1);
2374ceaec73dSDamien Bergamini 	if (error != 0)
2375ceaec73dSDamien Bergamini 		return error;
2376ceaec73dSDamien Bergamini 
2377ceaec73dSDamien Bergamini 	memset(&assoc, 0, sizeof assoc);
2378ceaec73dSDamien Bergamini 	assoc.mode = IEEE80211_IS_CHAN_5GHZ(ni->ni_chan) ? IWI_MODE_11A :
2379ceaec73dSDamien Bergamini 	    IWI_MODE_11G;
2380ceaec73dSDamien Bergamini 	assoc.chan = ieee80211_chan2ieee(ic, ni->ni_chan);
2381ceaec73dSDamien Bergamini 	if (ni->ni_authmode == IEEE80211_AUTH_SHARED)
2382ceaec73dSDamien Bergamini 		assoc.auth = ic->ic_crypto.cs_def_txkey << 4 | IWI_AUTH_SHARED;
2383ec01dc2bSDamien Bergamini 	if ((ic->ic_flags & IEEE80211_F_WME) && ni->ni_wme_ie != NULL)
2384ec01dc2bSDamien Bergamini 		assoc.policy |= htole16(IWI_POLICY_WME);
2385acea4241SDamien Bergamini 	if (ic->ic_opt_ie != NULL)
2386ec01dc2bSDamien Bergamini 		assoc.policy |= htole16(IWI_POLICY_WPA);
2387ceaec73dSDamien Bergamini 	memcpy(assoc.tstamp, ni->ni_tstamp.data, 8);
2388acea4241SDamien Bergamini 
2389acea4241SDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_IBSS)
2390acea4241SDamien Bergamini 		capinfo = IEEE80211_CAPINFO_IBSS;
2391acea4241SDamien Bergamini 	else
2392acea4241SDamien Bergamini 		capinfo = IEEE80211_CAPINFO_ESS;
2393acea4241SDamien Bergamini 	if (ic->ic_flags & IEEE80211_F_PRIVACY)
2394acea4241SDamien Bergamini 		capinfo |= IEEE80211_CAPINFO_PRIVACY;
2395acea4241SDamien Bergamini 	if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) &&
2396acea4241SDamien Bergamini 	    IEEE80211_IS_CHAN_2GHZ(ni->ni_chan))
2397acea4241SDamien Bergamini 		capinfo |= IEEE80211_CAPINFO_SHORT_PREAMBLE;
2398acea4241SDamien Bergamini 	if (ic->ic_flags & IEEE80211_F_SHSLOT)
2399acea4241SDamien Bergamini 		capinfo |= IEEE80211_CAPINFO_SHORT_SLOTTIME;
2400acea4241SDamien Bergamini 	assoc.capinfo = htole16(capinfo);
2401acea4241SDamien Bergamini 
2402ceaec73dSDamien Bergamini 	assoc.lintval = htole16(ic->ic_lintval);
2403ceaec73dSDamien Bergamini 	assoc.intval = htole16(ni->ni_intval);
2404ceaec73dSDamien Bergamini 	IEEE80211_ADDR_COPY(assoc.bssid, ni->ni_bssid);
2405ceaec73dSDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_IBSS)
2406ceaec73dSDamien Bergamini 		IEEE80211_ADDR_COPY(assoc.dst, ifp->if_broadcastaddr);
2407ceaec73dSDamien Bergamini 	else
2408ceaec73dSDamien Bergamini 		IEEE80211_ADDR_COPY(assoc.dst, ni->ni_bssid);
2409ceaec73dSDamien Bergamini 
2410ceaec73dSDamien Bergamini 	DPRINTF(("Trying to associate to %6D channel %u auth %u\n",
2411ceaec73dSDamien Bergamini 	    assoc.bssid, ":", assoc.chan, assoc.auth));
2412ceaec73dSDamien Bergamini 	return iwi_cmd(sc, IWI_CMD_ASSOCIATE, &assoc, sizeof assoc, 1);
2413ceaec73dSDamien Bergamini }
2414ceaec73dSDamien Bergamini 
2415ceaec73dSDamien Bergamini static void
2416ceaec73dSDamien Bergamini iwi_init(void *priv)
2417ceaec73dSDamien Bergamini {
2418ceaec73dSDamien Bergamini 	struct iwi_softc *sc = priv;
2419ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2420ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
2421ceaec73dSDamien Bergamini 	struct iwi_rx_data *data;
2422408146edSDamien Bergamini 	const char *uc, *fw;
2423ceaec73dSDamien Bergamini 	int i;
2424ceaec73dSDamien Bergamini 
2425ceaec73dSDamien Bergamini 	iwi_stop(sc);
2426ceaec73dSDamien Bergamini 
2427ceaec73dSDamien Bergamini 	if (iwi_reset(sc) != 0) {
2428ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not reset adapter\n");
2429ceaec73dSDamien Bergamini 		goto fail;
2430ceaec73dSDamien Bergamini 	}
2431ceaec73dSDamien Bergamini 
2432408146edSDamien Bergamini 	switch (ic->ic_opmode) {
2433408146edSDamien Bergamini 	case IEEE80211_M_STA:
2434408146edSDamien Bergamini 		uc = "iwi-ucode-bss";
2435408146edSDamien Bergamini 		fw = "iwi-bss";
2436408146edSDamien Bergamini 		break;
2437408146edSDamien Bergamini 
2438408146edSDamien Bergamini 	case IEEE80211_M_IBSS:
2439408146edSDamien Bergamini 		uc = "iwi-ucode-ibss";
2440408146edSDamien Bergamini 		fw = "iwi-ibss";
2441408146edSDamien Bergamini 		break;
2442408146edSDamien Bergamini 
2443408146edSDamien Bergamini 	case IEEE80211_M_MONITOR:
2444408146edSDamien Bergamini 		uc = "iwi-ucode-monitor";
2445408146edSDamien Bergamini 		fw = "iwi-monitor";
2446408146edSDamien Bergamini 		break;
2447408146edSDamien Bergamini 
2448408146edSDamien Bergamini 	default:
2449408146edSDamien Bergamini 		uc = fw = NULL;	/* should not get there */
2450408146edSDamien Bergamini 		break;
2451408146edSDamien Bergamini 	}
2452408146edSDamien Bergamini 
2453408146edSDamien Bergamini 	if (iwi_load_firmware(sc, "iwi-boot") != 0) {
2454ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load boot firmware\n");
2455ceaec73dSDamien Bergamini 		goto fail;
2456ceaec73dSDamien Bergamini 	}
2457ceaec73dSDamien Bergamini 
2458408146edSDamien Bergamini 	if (iwi_load_ucode(sc, uc) != 0) {
2459ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load microcode\n");
2460ceaec73dSDamien Bergamini 		goto fail;
2461ceaec73dSDamien Bergamini 	}
2462ceaec73dSDamien Bergamini 
2463ceaec73dSDamien Bergamini 	iwi_stop_master(sc);
2464ceaec73dSDamien Bergamini 
2465ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CMD_BASE, sc->cmdq.physaddr);
2466ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CMD_SIZE, sc->cmdq.count);
2467ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CMD_WIDX, sc->cmdq.cur);
2468ceaec73dSDamien Bergamini 
2469ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX1_BASE, sc->txq[0].physaddr);
2470ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX1_SIZE, sc->txq[0].count);
2471ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX1_WIDX, sc->txq[0].cur);
2472ceaec73dSDamien Bergamini 
2473ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX2_BASE, sc->txq[1].physaddr);
2474ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX2_SIZE, sc->txq[1].count);
2475ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX2_WIDX, sc->txq[1].cur);
2476ceaec73dSDamien Bergamini 
2477ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX3_BASE, sc->txq[2].physaddr);
2478ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX3_SIZE, sc->txq[2].count);
2479ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX3_WIDX, sc->txq[2].cur);
2480ceaec73dSDamien Bergamini 
2481ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX4_BASE, sc->txq[3].physaddr);
2482ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX4_SIZE, sc->txq[3].count);
2483ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX4_WIDX, sc->txq[3].cur);
2484ceaec73dSDamien Bergamini 
2485ceaec73dSDamien Bergamini 	for (i = 0; i < sc->rxq.count; i++) {
2486ceaec73dSDamien Bergamini 		data = &sc->rxq.data[i];
2487ceaec73dSDamien Bergamini 		CSR_WRITE_4(sc, data->reg, data->physaddr);
2488ceaec73dSDamien Bergamini 	}
2489ceaec73dSDamien Bergamini 
2490ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RX_WIDX, sc->rxq.count - 1);
2491ceaec73dSDamien Bergamini 
2492408146edSDamien Bergamini 	if (iwi_load_firmware(sc, fw) != 0) {
2493ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load main firmware\n");
2494ceaec73dSDamien Bergamini 		goto fail;
2495ceaec73dSDamien Bergamini 	}
2496ceaec73dSDamien Bergamini 
2497ceaec73dSDamien Bergamini 	sc->flags |= IWI_FLAG_FW_INITED;
2498ceaec73dSDamien Bergamini 
2499ceaec73dSDamien Bergamini 	if (iwi_config(sc) != 0) {
2500ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "device configuration failed\n");
2501ceaec73dSDamien Bergamini 		goto fail;
2502ceaec73dSDamien Bergamini 	}
2503ceaec73dSDamien Bergamini 
2504e0454c26SDamien Bergamini 	if (ic->ic_opmode != IEEE80211_M_MONITOR) {
2505e0454c26SDamien Bergamini 		if (ic->ic_roaming != IEEE80211_ROAMING_MANUAL)
2506acea4241SDamien Bergamini 			ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
2507e0454c26SDamien Bergamini 	} else
2508e0454c26SDamien Bergamini 		ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
2509ceaec73dSDamien Bergamini 
251013f4c340SRobert Watson 	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
251113f4c340SRobert Watson 	ifp->if_drv_flags |= IFF_DRV_RUNNING;
2512ceaec73dSDamien Bergamini 
2513ceaec73dSDamien Bergamini 	return;
2514ceaec73dSDamien Bergamini 
2515ceaec73dSDamien Bergamini fail:	ifp->if_flags &= ~IFF_UP;
2516ceaec73dSDamien Bergamini 	iwi_stop(sc);
2517ceaec73dSDamien Bergamini }
2518ceaec73dSDamien Bergamini 
2519ceaec73dSDamien Bergamini static void
2520ceaec73dSDamien Bergamini iwi_stop(void *priv)
2521ceaec73dSDamien Bergamini {
2522ceaec73dSDamien Bergamini 	struct iwi_softc *sc = priv;
2523ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2524ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
2525ceaec73dSDamien Bergamini 
2526ceaec73dSDamien Bergamini 	iwi_stop_master(sc);
2527ceaec73dSDamien Bergamini 
2528ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, IWI_RST_SOFT_RESET);
2529ceaec73dSDamien Bergamini 
2530ceaec73dSDamien Bergamini 	/* reset rings */
2531ceaec73dSDamien Bergamini 	iwi_reset_cmd_ring(sc, &sc->cmdq);
2532ec01dc2bSDamien Bergamini 	iwi_reset_tx_ring(sc, &sc->txq[0]);
2533ec01dc2bSDamien Bergamini 	iwi_reset_tx_ring(sc, &sc->txq[1]);
2534ec01dc2bSDamien Bergamini 	iwi_reset_tx_ring(sc, &sc->txq[2]);
2535ec01dc2bSDamien Bergamini 	iwi_reset_tx_ring(sc, &sc->txq[3]);
2536ceaec73dSDamien Bergamini 	iwi_reset_rx_ring(sc, &sc->rxq);
2537ceaec73dSDamien Bergamini 
2538ceaec73dSDamien Bergamini 	sc->sc_tx_timer = 0;
2539ceaec73dSDamien Bergamini 	ifp->if_timer = 0;
254013f4c340SRobert Watson 	ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
2541ceaec73dSDamien Bergamini 
2542ceaec73dSDamien Bergamini 	ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
2543ceaec73dSDamien Bergamini }
2544ceaec73dSDamien Bergamini 
2545408146edSDamien Bergamini /*
2546408146edSDamien Bergamini  * Read firmware image from the filesystem and load it into kernel memory.
2547408146edSDamien Bergamini  * Must be called from a process context.
2548408146edSDamien Bergamini  */
2549408146edSDamien Bergamini static int
2550408146edSDamien Bergamini iwi_read_firmware(const char *name, caddr_t *bufp, size_t *len)
2551408146edSDamien Bergamini {
2552408146edSDamien Bergamini 	char path[64];
2553408146edSDamien Bergamini 	struct thread *td = curthread;
2554408146edSDamien Bergamini 	struct nameidata nd;
2555408146edSDamien Bergamini 	struct vattr va;
2556408146edSDamien Bergamini 	struct iovec iov;
2557408146edSDamien Bergamini 	struct uio uio;
2558408146edSDamien Bergamini 	caddr_t buf;
2559408146edSDamien Bergamini 	int vfslocked, error;
2560408146edSDamien Bergamini 
2561408146edSDamien Bergamini 	snprintf(path, sizeof path, "/etc/firmware/%s.fw", name);
2562408146edSDamien Bergamini 
2563408146edSDamien Bergamini 	NDINIT(&nd, LOOKUP, NOFOLLOW | LOCKLEAF | MPSAFE, UIO_SYSSPACE, path,
2564408146edSDamien Bergamini 	    td);
2565408146edSDamien Bergamini 	if ((error = namei(&nd)) != 0)
2566408146edSDamien Bergamini 		goto fail1;
2567408146edSDamien Bergamini 
2568408146edSDamien Bergamini 	vfslocked = NDHASGIANT(&nd);
2569408146edSDamien Bergamini 
2570408146edSDamien Bergamini 	if ((error = VOP_GETATTR(nd.ni_vp, &va, td->td_ucred, td)) != 0)
2571408146edSDamien Bergamini 		goto fail2;
2572408146edSDamien Bergamini 
2573408146edSDamien Bergamini 	/* limit firmware size to 256KB */
2574408146edSDamien Bergamini 	if (va.va_size > 256 * 1024) {
2575408146edSDamien Bergamini 		error = E2BIG;
2576408146edSDamien Bergamini 		goto fail2;
2577408146edSDamien Bergamini 	}
2578408146edSDamien Bergamini 
2579408146edSDamien Bergamini 	if ((buf = malloc(va.va_size, M_DEVBUF, M_NOWAIT)) == NULL) {
2580408146edSDamien Bergamini 		error = ENOMEM;
2581408146edSDamien Bergamini 		goto fail2;
2582408146edSDamien Bergamini 	}
2583408146edSDamien Bergamini 
2584408146edSDamien Bergamini 	/* read the whole image at once */
2585408146edSDamien Bergamini 	uio.uio_iov = &iov;
2586408146edSDamien Bergamini 	uio.uio_iovcnt = 1;
2587408146edSDamien Bergamini 	iov.iov_base = buf;
2588408146edSDamien Bergamini 	iov.iov_len = va.va_size;
2589408146edSDamien Bergamini 	uio.uio_offset = 0;
2590408146edSDamien Bergamini 	uio.uio_resid = va.va_size;
2591408146edSDamien Bergamini 	uio.uio_segflg = UIO_SYSSPACE;
2592408146edSDamien Bergamini 	uio.uio_rw = UIO_READ;
2593408146edSDamien Bergamini 	uio.uio_td = td;
2594408146edSDamien Bergamini 
2595408146edSDamien Bergamini 	if ((error = VOP_READ(nd.ni_vp, &uio, 0, NOCRED)) != 0)
2596408146edSDamien Bergamini 		goto fail3;
2597408146edSDamien Bergamini 
2598408146edSDamien Bergamini 	*bufp = buf;
2599408146edSDamien Bergamini 	*len = va.va_size;
2600408146edSDamien Bergamini 
2601408146edSDamien Bergamini 	vput(nd.ni_vp);
2602408146edSDamien Bergamini 	VFS_UNLOCK_GIANT(vfslocked);
2603408146edSDamien Bergamini 
2604408146edSDamien Bergamini 	return 0;
2605408146edSDamien Bergamini 
2606408146edSDamien Bergamini fail3:	free(buf, M_DEVBUF);
2607408146edSDamien Bergamini fail2:	vput(nd.ni_vp);
2608408146edSDamien Bergamini 	VFS_UNLOCK_GIANT(vfslocked);
2609408146edSDamien Bergamini fail1:
2610408146edSDamien Bergamini 	return error;
2611408146edSDamien Bergamini }
2612408146edSDamien Bergamini 
2613ceaec73dSDamien Bergamini static int
2614ceaec73dSDamien Bergamini iwi_sysctl_stats(SYSCTL_HANDLER_ARGS)
2615ceaec73dSDamien Bergamini {
2616ceaec73dSDamien Bergamini 	struct iwi_softc *sc = arg1;
2617ceaec73dSDamien Bergamini 	uint32_t size, buf[128];
2618ceaec73dSDamien Bergamini 
2619ceaec73dSDamien Bergamini 	if (!(sc->flags & IWI_FLAG_FW_INITED)) {
2620ceaec73dSDamien Bergamini 		memset(buf, 0, sizeof buf);
2621ceaec73dSDamien Bergamini 		return SYSCTL_OUT(req, buf, sizeof buf);
2622ceaec73dSDamien Bergamini 	}
2623ceaec73dSDamien Bergamini 
2624ceaec73dSDamien Bergamini 	size = min(CSR_READ_4(sc, IWI_CSR_TABLE0_SIZE), 128 - 1);
2625ceaec73dSDamien Bergamini 	CSR_READ_REGION_4(sc, IWI_CSR_TABLE0_BASE, &buf[1], size);
2626ceaec73dSDamien Bergamini 
2627ceaec73dSDamien Bergamini 	return SYSCTL_OUT(req, buf, sizeof buf);
2628ceaec73dSDamien Bergamini }
2629ceaec73dSDamien Bergamini 
2630ceaec73dSDamien Bergamini static int
2631ceaec73dSDamien Bergamini iwi_sysctl_radio(SYSCTL_HANDLER_ARGS)
2632ceaec73dSDamien Bergamini {
2633ceaec73dSDamien Bergamini 	struct iwi_softc *sc = arg1;
2634ceaec73dSDamien Bergamini 	int val;
2635ceaec73dSDamien Bergamini 
2636ceaec73dSDamien Bergamini 	val = (CSR_READ_4(sc, IWI_CSR_IO) & IWI_IO_RADIO_ENABLED) ? 1 : 0;
2637ceaec73dSDamien Bergamini 
2638ceaec73dSDamien Bergamini 	return SYSCTL_OUT(req, &val, sizeof val);
2639ceaec73dSDamien Bergamini }
2640