xref: /freebsd/sys/dev/ipw/if_ipw.c (revision cbe2bd55ad7d0bd0ae26b0bd453ee9ba374d683a)
1ceaec73dSDamien Bergamini /*	$FreeBSD$	*/
2ceaec73dSDamien Bergamini 
3ceaec73dSDamien Bergamini /*-
484ca7670SDamien Bergamini  * Copyright (c) 2004-2006
5ceaec73dSDamien Bergamini  *      Damien Bergamini <damien.bergamini@free.fr>. All rights reserved.
6ceaec73dSDamien Bergamini  *
7ceaec73dSDamien Bergamini  * Redistribution and use in source and binary forms, with or without
8ceaec73dSDamien Bergamini  * modification, are permitted provided that the following conditions
9ceaec73dSDamien Bergamini  * are met:
10ceaec73dSDamien Bergamini  * 1. Redistributions of source code must retain the above copyright
11ceaec73dSDamien Bergamini  *    notice unmodified, this list of conditions, and the following
12ceaec73dSDamien Bergamini  *    disclaimer.
13ceaec73dSDamien Bergamini  * 2. Redistributions in binary form must reproduce the above copyright
14ceaec73dSDamien Bergamini  *    notice, this list of conditions and the following disclaimer in the
15ceaec73dSDamien Bergamini  *    documentation and/or other materials provided with the distribution.
16ceaec73dSDamien Bergamini  *
17ceaec73dSDamien Bergamini  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18ceaec73dSDamien Bergamini  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19ceaec73dSDamien Bergamini  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20ceaec73dSDamien Bergamini  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21ceaec73dSDamien Bergamini  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22ceaec73dSDamien Bergamini  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23ceaec73dSDamien Bergamini  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24ceaec73dSDamien Bergamini  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25ceaec73dSDamien Bergamini  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26ceaec73dSDamien Bergamini  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27ceaec73dSDamien Bergamini  * SUCH DAMAGE.
28ceaec73dSDamien Bergamini  */
29ceaec73dSDamien Bergamini 
30ceaec73dSDamien Bergamini #include <sys/cdefs.h>
31ceaec73dSDamien Bergamini __FBSDID("$FreeBSD$");
32ceaec73dSDamien Bergamini 
33ceaec73dSDamien Bergamini /*-
34ceaec73dSDamien Bergamini  * Intel(R) PRO/Wireless 2100 MiniPCI 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>
4684ca7670SDamien Bergamini #include <sys/queue.h>
4784ca7670SDamien Bergamini #include <sys/taskqueue.h>
48ceaec73dSDamien Bergamini #include <sys/module.h>
49ceaec73dSDamien Bergamini #include <sys/bus.h>
50ceaec73dSDamien Bergamini #include <sys/endian.h>
5184ca7670SDamien Bergamini #include <sys/linker.h>
5284ca7670SDamien Bergamini #include <sys/firmware.h>
53ceaec73dSDamien Bergamini 
54ceaec73dSDamien Bergamini #include <machine/bus.h>
55ceaec73dSDamien Bergamini #include <machine/resource.h>
56ceaec73dSDamien Bergamini #include <sys/rman.h>
57ceaec73dSDamien Bergamini 
58ceaec73dSDamien Bergamini #include <dev/pci/pcireg.h>
59ceaec73dSDamien Bergamini #include <dev/pci/pcivar.h>
60ceaec73dSDamien Bergamini 
61ceaec73dSDamien Bergamini #include <net/bpf.h>
62ceaec73dSDamien Bergamini #include <net/if.h>
63ceaec73dSDamien Bergamini #include <net/if_arp.h>
64ceaec73dSDamien Bergamini #include <net/ethernet.h>
65ceaec73dSDamien Bergamini #include <net/if_dl.h>
66ceaec73dSDamien Bergamini #include <net/if_media.h>
67ceaec73dSDamien Bergamini #include <net/if_types.h>
68ceaec73dSDamien Bergamini 
6984ca7670SDamien Bergamini #include <net80211/ieee80211_var.h>
7084ca7670SDamien Bergamini #include <net80211/ieee80211_radiotap.h>
7184ca7670SDamien Bergamini 
72ceaec73dSDamien Bergamini #include <netinet/in.h>
73ceaec73dSDamien Bergamini #include <netinet/in_systm.h>
74ceaec73dSDamien Bergamini #include <netinet/in_var.h>
75ceaec73dSDamien Bergamini #include <netinet/ip.h>
76ceaec73dSDamien Bergamini #include <netinet/if_ether.h>
77ceaec73dSDamien Bergamini 
78ceaec73dSDamien Bergamini #include <dev/ipw/if_ipwreg.h>
79ceaec73dSDamien Bergamini #include <dev/ipw/if_ipwvar.h>
80ceaec73dSDamien Bergamini 
81ceaec73dSDamien Bergamini #ifdef IPW_DEBUG
82ceaec73dSDamien Bergamini #define DPRINTF(x)	do { if (ipw_debug > 0) printf x; } while (0)
83ceaec73dSDamien Bergamini #define DPRINTFN(n, x)	do { if (ipw_debug >= (n)) printf x; } while (0)
84ceaec73dSDamien Bergamini int ipw_debug = 0;
85ceaec73dSDamien Bergamini SYSCTL_INT(_debug, OID_AUTO, ipw, CTLFLAG_RW, &ipw_debug, 0, "ipw debug level");
86ceaec73dSDamien Bergamini #else
87ceaec73dSDamien Bergamini #define DPRINTF(x)
88ceaec73dSDamien Bergamini #define DPRINTFN(n, x)
89ceaec73dSDamien Bergamini #endif
90ceaec73dSDamien Bergamini 
91ceaec73dSDamien Bergamini MODULE_DEPEND(ipw, pci,  1, 1, 1);
92ceaec73dSDamien Bergamini MODULE_DEPEND(ipw, wlan, 1, 1, 1);
9384ca7670SDamien Bergamini MODULE_DEPEND(ipw, firmware, 1, 1, 1);
94ceaec73dSDamien Bergamini 
95ceaec73dSDamien Bergamini struct ipw_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 ipw_ident ipw_ident_table[] = {
102ceaec73dSDamien Bergamini 	{ 0x8086, 0x1043, "Intel(R) PRO/Wireless 2100 MiniPCI" },
103ceaec73dSDamien Bergamini 
104ceaec73dSDamien Bergamini 	{ 0, 0, NULL }
105ceaec73dSDamien Bergamini };
106ceaec73dSDamien Bergamini 
107ceaec73dSDamien Bergamini static int	ipw_dma_alloc(struct ipw_softc *);
108ceaec73dSDamien Bergamini static void	ipw_release(struct ipw_softc *);
109ceaec73dSDamien Bergamini static int	ipw_media_change(struct ifnet *);
110ceaec73dSDamien Bergamini static void	ipw_media_status(struct ifnet *, struct ifmediareq *);
111ceaec73dSDamien Bergamini static int	ipw_newstate(struct ieee80211com *, enum ieee80211_state, int);
112ceaec73dSDamien Bergamini static uint16_t	ipw_read_prom_word(struct ipw_softc *, uint8_t);
113ceaec73dSDamien Bergamini static void	ipw_command_intr(struct ipw_softc *, struct ipw_soft_buf *);
114ceaec73dSDamien Bergamini static void	ipw_newstate_intr(struct ipw_softc *, struct ipw_soft_buf *);
115ceaec73dSDamien Bergamini static void	ipw_data_intr(struct ipw_softc *, struct ipw_status *,
116ceaec73dSDamien Bergamini 		    struct ipw_soft_bd *, struct ipw_soft_buf *);
117ceaec73dSDamien Bergamini static void	ipw_rx_intr(struct ipw_softc *);
118ceaec73dSDamien Bergamini static void	ipw_release_sbd(struct ipw_softc *, struct ipw_soft_bd *);
119ceaec73dSDamien Bergamini static void	ipw_tx_intr(struct ipw_softc *);
120ceaec73dSDamien Bergamini static void	ipw_intr(void *);
121ceaec73dSDamien Bergamini static void	ipw_dma_map_addr(void *, bus_dma_segment_t *, int, int);
122ceaec73dSDamien Bergamini static int	ipw_cmd(struct ipw_softc *, uint32_t, void *, uint32_t);
123ceaec73dSDamien Bergamini static int	ipw_tx_start(struct ifnet *, struct mbuf *,
124ceaec73dSDamien Bergamini 		    struct ieee80211_node *);
125ceaec73dSDamien Bergamini static void	ipw_start(struct ifnet *);
126ceaec73dSDamien Bergamini static void	ipw_watchdog(struct ifnet *);
127ceaec73dSDamien Bergamini static int	ipw_ioctl(struct ifnet *, u_long, caddr_t);
128ceaec73dSDamien Bergamini static void	ipw_stop_master(struct ipw_softc *);
129ceaec73dSDamien Bergamini static int	ipw_reset(struct ipw_softc *);
13084ca7670SDamien Bergamini static int	ipw_load_ucode(struct ipw_softc *, const char *, int);
13184ca7670SDamien Bergamini static int	ipw_load_firmware(struct ipw_softc *, const char *, int);
132ceaec73dSDamien Bergamini static int	ipw_config(struct ipw_softc *);
13384ca7670SDamien Bergamini static void	ipw_init_task(void *, int);
134ceaec73dSDamien Bergamini static void	ipw_init(void *);
135ceaec73dSDamien Bergamini static void	ipw_stop(void *);
136ceaec73dSDamien Bergamini static int	ipw_sysctl_stats(SYSCTL_HANDLER_ARGS);
137ceaec73dSDamien Bergamini static int	ipw_sysctl_radio(SYSCTL_HANDLER_ARGS);
138ceaec73dSDamien Bergamini static uint32_t	ipw_read_table1(struct ipw_softc *, uint32_t);
139ceaec73dSDamien Bergamini static void	ipw_write_table1(struct ipw_softc *, uint32_t, uint32_t);
140ceaec73dSDamien Bergamini static int	ipw_read_table2(struct ipw_softc *, uint32_t, void *,
141ceaec73dSDamien Bergamini 		    uint32_t *);
142ceaec73dSDamien Bergamini static void	ipw_read_mem_1(struct ipw_softc *, bus_size_t, uint8_t *,
143ceaec73dSDamien Bergamini 		    bus_size_t);
14484ca7670SDamien Bergamini static void	ipw_write_mem_1(struct ipw_softc *, bus_size_t,
14584ca7670SDamien Bergamini 		    const uint8_t *, bus_size_t);
146ceaec73dSDamien Bergamini 
147ceaec73dSDamien Bergamini static int ipw_probe(device_t);
148ceaec73dSDamien Bergamini static int ipw_attach(device_t);
149ceaec73dSDamien Bergamini static int ipw_detach(device_t);
150ceaec73dSDamien Bergamini static int ipw_shutdown(device_t);
151ceaec73dSDamien Bergamini static int ipw_suspend(device_t);
152ceaec73dSDamien Bergamini static int ipw_resume(device_t);
153ceaec73dSDamien Bergamini 
154ceaec73dSDamien Bergamini static device_method_t ipw_methods[] = {
155ceaec73dSDamien Bergamini 	/* Device interface */
156ceaec73dSDamien Bergamini 	DEVMETHOD(device_probe,		ipw_probe),
157ceaec73dSDamien Bergamini 	DEVMETHOD(device_attach,	ipw_attach),
158ceaec73dSDamien Bergamini 	DEVMETHOD(device_detach,	ipw_detach),
159ceaec73dSDamien Bergamini 	DEVMETHOD(device_shutdown,	ipw_shutdown),
160ceaec73dSDamien Bergamini 	DEVMETHOD(device_suspend,	ipw_suspend),
161ceaec73dSDamien Bergamini 	DEVMETHOD(device_resume,	ipw_resume),
162ceaec73dSDamien Bergamini 
163ceaec73dSDamien Bergamini 	{ 0, 0 }
164ceaec73dSDamien Bergamini };
165ceaec73dSDamien Bergamini 
166ceaec73dSDamien Bergamini static driver_t ipw_driver = {
167ceaec73dSDamien Bergamini 	"ipw",
168ceaec73dSDamien Bergamini 	ipw_methods,
169ceaec73dSDamien Bergamini 	sizeof (struct ipw_softc)
170ceaec73dSDamien Bergamini };
171ceaec73dSDamien Bergamini 
172ceaec73dSDamien Bergamini static devclass_t ipw_devclass;
173ceaec73dSDamien Bergamini 
174ceaec73dSDamien Bergamini DRIVER_MODULE(ipw, pci, ipw_driver, ipw_devclass, 0, 0);
175ceaec73dSDamien Bergamini 
176ceaec73dSDamien Bergamini /*
177ceaec73dSDamien Bergamini  * Supported rates for 802.11b mode (in 500Kbps unit).
178ceaec73dSDamien Bergamini  */
179ceaec73dSDamien Bergamini static const struct ieee80211_rateset ipw_rateset_11b =
180ceaec73dSDamien Bergamini 	{ 4, { 2, 4, 11, 22 } };
181ceaec73dSDamien Bergamini 
182ceaec73dSDamien Bergamini static int
183ceaec73dSDamien Bergamini ipw_probe(device_t dev)
184ceaec73dSDamien Bergamini {
185ceaec73dSDamien Bergamini 	const struct ipw_ident *ident;
186ceaec73dSDamien Bergamini 
187ceaec73dSDamien Bergamini 	for (ident = ipw_ident_table; ident->name != NULL; ident++) {
188ceaec73dSDamien Bergamini 		if (pci_get_vendor(dev) == ident->vendor &&
189ceaec73dSDamien Bergamini 		    pci_get_device(dev) == ident->device) {
190ceaec73dSDamien Bergamini 			device_set_desc(dev, ident->name);
191ceaec73dSDamien Bergamini 			return 0;
192ceaec73dSDamien Bergamini 		}
193ceaec73dSDamien Bergamini 	}
194ceaec73dSDamien Bergamini 	return ENXIO;
195ceaec73dSDamien Bergamini }
196ceaec73dSDamien Bergamini 
197ceaec73dSDamien Bergamini /* Base Address Register */
198ceaec73dSDamien Bergamini #define IPW_PCI_BAR0	0x10
199ceaec73dSDamien Bergamini 
200ceaec73dSDamien Bergamini static int
201ceaec73dSDamien Bergamini ipw_attach(device_t dev)
202ceaec73dSDamien Bergamini {
203ceaec73dSDamien Bergamini 	struct ipw_softc *sc = device_get_softc(dev);
204fc74a9f9SBrooks Davis 	struct ifnet *ifp;
205ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
206ceaec73dSDamien Bergamini 	uint16_t val;
207ceaec73dSDamien Bergamini 	int error, i;
208ceaec73dSDamien Bergamini 
209ceaec73dSDamien Bergamini 	sc->sc_dev = dev;
210ceaec73dSDamien Bergamini 
211ceaec73dSDamien Bergamini 	mtx_init(&sc->sc_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK,
212ceaec73dSDamien Bergamini 	    MTX_DEF | MTX_RECURSE);
213ceaec73dSDamien Bergamini 
21484ca7670SDamien Bergamini 	TASK_INIT(&sc->sc_init_task, 0, ipw_init_task, sc);
21584ca7670SDamien Bergamini 
216ceaec73dSDamien Bergamini 	if (pci_get_powerstate(dev) != PCI_POWERSTATE_D0) {
217ceaec73dSDamien Bergamini 		device_printf(dev, "chip is in D%d power mode "
218ceaec73dSDamien Bergamini 		    "-- setting to D0\n", pci_get_powerstate(dev));
219ceaec73dSDamien Bergamini 		pci_set_powerstate(dev, PCI_POWERSTATE_D0);
220ceaec73dSDamien Bergamini 	}
221ceaec73dSDamien Bergamini 
2220e22d2c5SDamien Bergamini 	pci_write_config(dev, 0x41, 0, 1);
2230e22d2c5SDamien Bergamini 
224ceaec73dSDamien Bergamini 	/* enable bus-mastering */
225ceaec73dSDamien Bergamini 	pci_enable_busmaster(dev);
226ceaec73dSDamien Bergamini 
227ceaec73dSDamien Bergamini 	sc->mem_rid = IPW_PCI_BAR0;
228ceaec73dSDamien Bergamini 	sc->mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->mem_rid,
229ceaec73dSDamien Bergamini 	    RF_ACTIVE);
230ceaec73dSDamien Bergamini 	if (sc->mem == NULL) {
231ceaec73dSDamien Bergamini 		device_printf(dev, "could not allocate memory resource\n");
232ceaec73dSDamien Bergamini 		goto fail;
233ceaec73dSDamien Bergamini 	}
234ceaec73dSDamien Bergamini 
235ceaec73dSDamien Bergamini 	sc->sc_st = rman_get_bustag(sc->mem);
236ceaec73dSDamien Bergamini 	sc->sc_sh = rman_get_bushandle(sc->mem);
237ceaec73dSDamien Bergamini 
238ceaec73dSDamien Bergamini 	sc->irq_rid = 0;
239ceaec73dSDamien Bergamini 	sc->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->irq_rid,
240ceaec73dSDamien Bergamini 	    RF_ACTIVE | RF_SHAREABLE);
241ceaec73dSDamien Bergamini 	if (sc->irq == NULL) {
242ceaec73dSDamien Bergamini 		device_printf(dev, "could not allocate interrupt resource\n");
243ceaec73dSDamien Bergamini 		goto fail;
244ceaec73dSDamien Bergamini 	}
245ceaec73dSDamien Bergamini 
246ceaec73dSDamien Bergamini 	if (ipw_reset(sc) != 0) {
247ceaec73dSDamien Bergamini 		device_printf(dev, "could not reset adapter\n");
248ceaec73dSDamien Bergamini 		goto fail;
249ceaec73dSDamien Bergamini 	}
250ceaec73dSDamien Bergamini 
251ceaec73dSDamien Bergamini 	if (ipw_dma_alloc(sc) != 0) {
252ceaec73dSDamien Bergamini 		device_printf(dev, "could not allocate DMA resources\n");
253ceaec73dSDamien Bergamini 		goto fail;
254ceaec73dSDamien Bergamini 	}
25509137879SDamien Bergamini 
256fc74a9f9SBrooks Davis 	ifp = sc->sc_ifp = if_alloc(IFT_ETHER);
257fc74a9f9SBrooks Davis 	if (ifp == NULL) {
258fc74a9f9SBrooks Davis 		device_printf(dev, "can not if_alloc()\n");
259fc74a9f9SBrooks Davis 		goto fail;
260fc74a9f9SBrooks Davis 	}
26109137879SDamien Bergamini 
262ceaec73dSDamien Bergamini 	ifp->if_softc = sc;
263ceaec73dSDamien Bergamini 	if_initname(ifp, device_get_name(dev), device_get_unit(dev));
264ceaec73dSDamien Bergamini 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
265ceaec73dSDamien Bergamini 	ifp->if_init = ipw_init;
266ceaec73dSDamien Bergamini 	ifp->if_ioctl = ipw_ioctl;
267ceaec73dSDamien Bergamini 	ifp->if_start = ipw_start;
268ceaec73dSDamien Bergamini 	ifp->if_watchdog = ipw_watchdog;
269ceaec73dSDamien Bergamini 	IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN);
270ceaec73dSDamien Bergamini 	ifp->if_snd.ifq_drv_maxlen = IFQ_MAXLEN;
271ceaec73dSDamien Bergamini 	IFQ_SET_READY(&ifp->if_snd);
272ceaec73dSDamien Bergamini 
273ceaec73dSDamien Bergamini 	ic->ic_ifp = ifp;
274ceaec73dSDamien Bergamini 	ic->ic_phytype = IEEE80211_T_DS;
275ceaec73dSDamien Bergamini 	ic->ic_opmode = IEEE80211_M_STA;
276ceaec73dSDamien Bergamini 	ic->ic_state = IEEE80211_S_INIT;
277ceaec73dSDamien Bergamini 
278ceaec73dSDamien Bergamini 	/* set device capabilities */
27984ca7670SDamien Bergamini 	ic->ic_caps =
28084ca7670SDamien Bergamini 	    IEEE80211_C_IBSS |		/* IBSS mode supported */
28184ca7670SDamien Bergamini 	    IEEE80211_C_MONITOR |	/* monitor mode supported */
28284ca7670SDamien Bergamini 	    IEEE80211_C_TXPMGT |	/* tx power management */
28384ca7670SDamien Bergamini 	    IEEE80211_C_SHPREAMBLE;	/* short preamble supported */
284ceaec73dSDamien Bergamini 
285ceaec73dSDamien Bergamini 	/* read MAC address from EEPROM */
286ceaec73dSDamien Bergamini 	val = ipw_read_prom_word(sc, IPW_EEPROM_MAC + 0);
287ceaec73dSDamien Bergamini 	ic->ic_myaddr[0] = val >> 8;
288ceaec73dSDamien Bergamini 	ic->ic_myaddr[1] = val & 0xff;
289ceaec73dSDamien Bergamini 	val = ipw_read_prom_word(sc, IPW_EEPROM_MAC + 1);
290ceaec73dSDamien Bergamini 	ic->ic_myaddr[2] = val >> 8;
291ceaec73dSDamien Bergamini 	ic->ic_myaddr[3] = val & 0xff;
292ceaec73dSDamien Bergamini 	val = ipw_read_prom_word(sc, IPW_EEPROM_MAC + 2);
293ceaec73dSDamien Bergamini 	ic->ic_myaddr[4] = val >> 8;
294ceaec73dSDamien Bergamini 	ic->ic_myaddr[5] = val & 0xff;
295ceaec73dSDamien Bergamini 
296ceaec73dSDamien Bergamini 	/* set supported .11b rates */
297ceaec73dSDamien Bergamini 	ic->ic_sup_rates[IEEE80211_MODE_11B] = ipw_rateset_11b;
298ceaec73dSDamien Bergamini 
299f3268efaSDamien Bergamini 	/* set supported .11b channels */
300f3268efaSDamien Bergamini 	for (i = 1; i < 14; i++) {
301ceaec73dSDamien Bergamini 		ic->ic_channels[i].ic_freq =
302ceaec73dSDamien Bergamini 		    ieee80211_ieee2mhz(i, IEEE80211_CHAN_B);
303ceaec73dSDamien Bergamini 		ic->ic_channels[i].ic_flags = IEEE80211_CHAN_B;
304ceaec73dSDamien Bergamini 	}
305ceaec73dSDamien Bergamini 
306ceaec73dSDamien Bergamini 	/* check support for radio transmitter switch in EEPROM */
307ceaec73dSDamien Bergamini 	if (!(ipw_read_prom_word(sc, IPW_EEPROM_RADIO) & 8))
308ceaec73dSDamien Bergamini 		sc->flags |= IPW_FLAG_HAS_RADIO_SWITCH;
309ceaec73dSDamien Bergamini 
310ceaec73dSDamien Bergamini 	ieee80211_ifattach(ic);
311ceaec73dSDamien Bergamini 	/* override state transition machine */
312ceaec73dSDamien Bergamini 	sc->sc_newstate = ic->ic_newstate;
313ceaec73dSDamien Bergamini 	ic->ic_newstate = ipw_newstate;
314ceaec73dSDamien Bergamini 	ieee80211_media_init(ic, ipw_media_change, ipw_media_status);
315ceaec73dSDamien Bergamini 
316ceaec73dSDamien Bergamini 	bpfattach2(ifp, DLT_IEEE802_11_RADIO,
317ceaec73dSDamien Bergamini 	    sizeof (struct ieee80211_frame) + 64, &sc->sc_drvbpf);
318ceaec73dSDamien Bergamini 
319ceaec73dSDamien Bergamini 	sc->sc_rxtap_len = sizeof sc->sc_rxtapu;
320ceaec73dSDamien Bergamini 	sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len);
321ceaec73dSDamien Bergamini 	sc->sc_rxtap.wr_ihdr.it_present = htole32(IPW_RX_RADIOTAP_PRESENT);
322ceaec73dSDamien Bergamini 
323ceaec73dSDamien Bergamini 	sc->sc_txtap_len = sizeof sc->sc_txtapu;
324ceaec73dSDamien Bergamini 	sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len);
325ceaec73dSDamien Bergamini 	sc->sc_txtap.wt_ihdr.it_present = htole32(IPW_TX_RADIOTAP_PRESENT);
326ceaec73dSDamien Bergamini 
327ceaec73dSDamien Bergamini 	/*
328ceaec73dSDamien Bergamini 	 * Add a few sysctl knobs.
329ceaec73dSDamien Bergamini 	 */
330ceaec73dSDamien Bergamini 	sc->dwelltime = 100;
331ceaec73dSDamien Bergamini 
332ceaec73dSDamien Bergamini 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
333ceaec73dSDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "radio",
334ceaec73dSDamien Bergamini 	    CTLTYPE_INT | CTLFLAG_RD, sc, 0, ipw_sysctl_radio, "I",
335ceaec73dSDamien Bergamini 	    "radio transmitter switch state (0=off, 1=on)");
336ceaec73dSDamien Bergamini 
337ceaec73dSDamien Bergamini 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
338ceaec73dSDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "stats",
339ceaec73dSDamien Bergamini 	    CTLTYPE_OPAQUE | CTLFLAG_RD, sc, 0, ipw_sysctl_stats, "S",
340ceaec73dSDamien Bergamini 	    "statistics");
341ceaec73dSDamien Bergamini 
342ceaec73dSDamien Bergamini 	SYSCTL_ADD_INT(device_get_sysctl_ctx(dev),
343ceaec73dSDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "dwell",
344ceaec73dSDamien Bergamini 	    CTLFLAG_RW, &sc->dwelltime, 0,
345ceaec73dSDamien Bergamini 	    "channel dwell time (ms) for AP/station scanning");
346ceaec73dSDamien Bergamini 
347ceaec73dSDamien Bergamini 	/*
348ceaec73dSDamien Bergamini 	 * Hook our interrupt after all initialization is complete.
349ceaec73dSDamien Bergamini 	 */
350ceaec73dSDamien Bergamini 	error = bus_setup_intr(dev, sc->irq, INTR_TYPE_NET | INTR_MPSAFE,
351ceaec73dSDamien Bergamini 	    ipw_intr, sc, &sc->sc_ih);
352ceaec73dSDamien Bergamini 	if (error != 0) {
353ceaec73dSDamien Bergamini 		device_printf(dev, "could not set up interrupt\n");
354ceaec73dSDamien Bergamini 		goto fail;
355ceaec73dSDamien Bergamini 	}
356ceaec73dSDamien Bergamini 
357ceaec73dSDamien Bergamini 	if (bootverbose)
358ceaec73dSDamien Bergamini 		ieee80211_announce(ic);
359ceaec73dSDamien Bergamini 
360ceaec73dSDamien Bergamini 	return 0;
361ceaec73dSDamien Bergamini 
362ceaec73dSDamien Bergamini fail:	ipw_detach(dev);
363ceaec73dSDamien Bergamini 	return ENXIO;
364ceaec73dSDamien Bergamini }
365ceaec73dSDamien Bergamini 
366ceaec73dSDamien Bergamini static int
367ceaec73dSDamien Bergamini ipw_detach(device_t dev)
368ceaec73dSDamien Bergamini {
369ceaec73dSDamien Bergamini 	struct ipw_softc *sc = device_get_softc(dev);
370ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
371ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
372ceaec73dSDamien Bergamini 
373ceaec73dSDamien Bergamini 	ipw_stop(sc);
374ceaec73dSDamien Bergamini 
37509137879SDamien Bergamini 	if (ifp != NULL) {
376ceaec73dSDamien Bergamini 		bpfdetach(ifp);
377ceaec73dSDamien Bergamini 		ieee80211_ifdetach(ic);
37809137879SDamien Bergamini 	}
379ceaec73dSDamien Bergamini 
380ceaec73dSDamien Bergamini 	ipw_release(sc);
381ceaec73dSDamien Bergamini 
382ceaec73dSDamien Bergamini 	if (sc->irq != NULL) {
383ceaec73dSDamien Bergamini 		bus_teardown_intr(dev, sc->irq, sc->sc_ih);
384ceaec73dSDamien Bergamini 		bus_release_resource(dev, SYS_RES_IRQ, sc->irq_rid, sc->irq);
385ceaec73dSDamien Bergamini 	}
386ceaec73dSDamien Bergamini 
387ceaec73dSDamien Bergamini 	if (sc->mem != NULL)
388ceaec73dSDamien Bergamini 		bus_release_resource(dev, SYS_RES_MEMORY, sc->mem_rid, sc->mem);
38984ca7670SDamien Bergamini 
390ad4f426eSWarner Losh 	if (ifp != NULL)
391ad4f426eSWarner Losh 		if_free(ifp);
392ceaec73dSDamien Bergamini 
393cbe2bd55SIan Dowse 	if (sc->sc_firmware != NULL) {
394cbe2bd55SIan Dowse 		firmware_put(sc->sc_firmware, FIRMWARE_UNLOAD);
395cbe2bd55SIan Dowse 		sc->sc_firmware = NULL;
396cbe2bd55SIan Dowse 	}
397cbe2bd55SIan Dowse 
398ceaec73dSDamien Bergamini 	mtx_destroy(&sc->sc_mtx);
399ceaec73dSDamien Bergamini 
400ceaec73dSDamien Bergamini 	return 0;
401ceaec73dSDamien Bergamini }
402ceaec73dSDamien Bergamini 
403ceaec73dSDamien Bergamini static int
404ceaec73dSDamien Bergamini ipw_dma_alloc(struct ipw_softc *sc)
405ceaec73dSDamien Bergamini {
406ceaec73dSDamien Bergamini 	struct ipw_soft_bd *sbd;
407ceaec73dSDamien Bergamini 	struct ipw_soft_hdr *shdr;
408ceaec73dSDamien Bergamini 	struct ipw_soft_buf *sbuf;
409ceaec73dSDamien Bergamini 	bus_addr_t physaddr;
410ceaec73dSDamien Bergamini 	int error, i;
411ceaec73dSDamien Bergamini 
412ceaec73dSDamien Bergamini 	/*
413ceaec73dSDamien Bergamini 	 * Allocate and map tx ring.
414ceaec73dSDamien Bergamini 	 */
415ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
416ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, IPW_TBD_SZ, 1, IPW_TBD_SZ, 0, NULL,
417ceaec73dSDamien Bergamini 	    NULL, &sc->tbd_dmat);
418ceaec73dSDamien Bergamini 	if (error != 0) {
419ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create tx ring DMA tag\n");
420ceaec73dSDamien Bergamini 		goto fail;
421ceaec73dSDamien Bergamini 	}
422ceaec73dSDamien Bergamini 
423ceaec73dSDamien Bergamini 	error = bus_dmamem_alloc(sc->tbd_dmat, (void **)&sc->tbd_list,
424ceaec73dSDamien Bergamini 	    BUS_DMA_NOWAIT | BUS_DMA_ZERO, &sc->tbd_map);
425ceaec73dSDamien Bergamini 	if (error != 0) {
426ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
427ceaec73dSDamien Bergamini 		    "could not allocate tx ring DMA memory\n");
428ceaec73dSDamien Bergamini 		goto fail;
429ceaec73dSDamien Bergamini 	}
430ceaec73dSDamien Bergamini 
431ceaec73dSDamien Bergamini 	error = bus_dmamap_load(sc->tbd_dmat, sc->tbd_map, sc->tbd_list,
432ceaec73dSDamien Bergamini 	    IPW_TBD_SZ, ipw_dma_map_addr, &sc->tbd_phys, 0);
433ceaec73dSDamien Bergamini 	if (error != 0) {
434ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not map tx ring DMA memory\n");
435ceaec73dSDamien Bergamini 		goto fail;
436ceaec73dSDamien Bergamini 	}
437ceaec73dSDamien Bergamini 
438ceaec73dSDamien Bergamini 	/*
439ceaec73dSDamien Bergamini 	 * Allocate and map rx ring.
440ceaec73dSDamien Bergamini 	 */
441ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
442ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, IPW_RBD_SZ, 1, IPW_RBD_SZ, 0, NULL,
443ceaec73dSDamien Bergamini 	    NULL, &sc->rbd_dmat);
444ceaec73dSDamien Bergamini 	if (error != 0) {
445ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create rx ring DMA tag\n");
446ceaec73dSDamien Bergamini 		goto fail;
447ceaec73dSDamien Bergamini 	}
448ceaec73dSDamien Bergamini 
449ceaec73dSDamien Bergamini 	error = bus_dmamem_alloc(sc->rbd_dmat, (void **)&sc->rbd_list,
450ceaec73dSDamien Bergamini 	    BUS_DMA_NOWAIT | BUS_DMA_ZERO, &sc->rbd_map);
451ceaec73dSDamien Bergamini 	if (error != 0) {
452ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
453ceaec73dSDamien Bergamini 		    "could not allocate rx ring DMA memory\n");
454ceaec73dSDamien Bergamini 		goto fail;
455ceaec73dSDamien Bergamini 	}
456ceaec73dSDamien Bergamini 
457ceaec73dSDamien Bergamini 	error = bus_dmamap_load(sc->rbd_dmat, sc->rbd_map, sc->rbd_list,
458ceaec73dSDamien Bergamini 	    IPW_RBD_SZ, ipw_dma_map_addr, &sc->rbd_phys, 0);
459ceaec73dSDamien Bergamini 	if (error != 0) {
460ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not map rx ring DMA memory\n");
461ceaec73dSDamien Bergamini 		goto fail;
462ceaec73dSDamien Bergamini 	}
463ceaec73dSDamien Bergamini 
464ceaec73dSDamien Bergamini 	/*
465ceaec73dSDamien Bergamini 	 * Allocate and map status ring.
466ceaec73dSDamien Bergamini 	 */
467ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
468ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, IPW_STATUS_SZ, 1, IPW_STATUS_SZ, 0,
469ceaec73dSDamien Bergamini 	    NULL, NULL, &sc->status_dmat);
470ceaec73dSDamien Bergamini 	if (error != 0) {
471ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
472ceaec73dSDamien Bergamini 		    "could not create status ring DMA tag\n");
473ceaec73dSDamien Bergamini 		goto fail;
474ceaec73dSDamien Bergamini 	}
475ceaec73dSDamien Bergamini 
476ceaec73dSDamien Bergamini 	error = bus_dmamem_alloc(sc->status_dmat, (void **)&sc->status_list,
477ceaec73dSDamien Bergamini 	    BUS_DMA_NOWAIT | BUS_DMA_ZERO, &sc->status_map);
478ceaec73dSDamien Bergamini 	if (error != 0) {
479ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
480ceaec73dSDamien Bergamini 		    "could not allocate status ring DMA memory\n");
481ceaec73dSDamien Bergamini 		goto fail;
482ceaec73dSDamien Bergamini 	}
483ceaec73dSDamien Bergamini 
484ceaec73dSDamien Bergamini 	error = bus_dmamap_load(sc->status_dmat, sc->status_map,
485ceaec73dSDamien Bergamini 	    sc->status_list, IPW_STATUS_SZ, ipw_dma_map_addr, &sc->status_phys,
486ceaec73dSDamien Bergamini 	    0);
487ceaec73dSDamien Bergamini 	if (error != 0) {
488ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
489ceaec73dSDamien Bergamini 		    "could not map status ring DMA memory\n");
490ceaec73dSDamien Bergamini 		goto fail;
491ceaec73dSDamien Bergamini 	}
492ceaec73dSDamien Bergamini 
493ceaec73dSDamien Bergamini 	/*
494ceaec73dSDamien Bergamini 	 * Allocate command DMA map.
495ceaec73dSDamien Bergamini 	 */
496ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT,
497ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, sizeof (struct ipw_cmd), 1,
498ceaec73dSDamien Bergamini 	    sizeof (struct ipw_cmd), 0, NULL, NULL, &sc->cmd_dmat);
499ceaec73dSDamien Bergamini 	if (error != 0) {
500ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create command DMA tag\n");
501ceaec73dSDamien Bergamini 		goto fail;
502ceaec73dSDamien Bergamini 	}
503ceaec73dSDamien Bergamini 
504ceaec73dSDamien Bergamini 	error = bus_dmamap_create(sc->cmd_dmat, 0, &sc->cmd_map);
505ceaec73dSDamien Bergamini 	if (error != 0) {
506ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
507ceaec73dSDamien Bergamini 		    "could not create command DMA map\n");
508ceaec73dSDamien Bergamini 		goto fail;
509ceaec73dSDamien Bergamini 	}
510ceaec73dSDamien Bergamini 
511ceaec73dSDamien Bergamini 	/*
512ceaec73dSDamien Bergamini 	 * Allocate headers DMA maps.
513ceaec73dSDamien Bergamini 	 */
514ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT,
515ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, sizeof (struct ipw_hdr), 1,
516ceaec73dSDamien Bergamini 	    sizeof (struct ipw_hdr), 0, NULL, NULL, &sc->hdr_dmat);
517ceaec73dSDamien Bergamini 	if (error != 0) {
518ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create header DMA tag\n");
519ceaec73dSDamien Bergamini 		goto fail;
520ceaec73dSDamien Bergamini 	}
521ceaec73dSDamien Bergamini 
522ceaec73dSDamien Bergamini 	SLIST_INIT(&sc->free_shdr);
523ceaec73dSDamien Bergamini 	for (i = 0; i < IPW_NDATA; i++) {
524ceaec73dSDamien Bergamini 		shdr = &sc->shdr_list[i];
525ceaec73dSDamien Bergamini 		error = bus_dmamap_create(sc->hdr_dmat, 0, &shdr->map);
526ceaec73dSDamien Bergamini 		if (error != 0) {
527ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
528ceaec73dSDamien Bergamini 			    "could not create header DMA map\n");
529ceaec73dSDamien Bergamini 			goto fail;
530ceaec73dSDamien Bergamini 		}
531ceaec73dSDamien Bergamini 		SLIST_INSERT_HEAD(&sc->free_shdr, shdr, next);
532ceaec73dSDamien Bergamini 	}
533ceaec73dSDamien Bergamini 
534ceaec73dSDamien Bergamini 	/*
535ceaec73dSDamien Bergamini 	 * Allocate tx buffers DMA maps.
536ceaec73dSDamien Bergamini 	 */
537ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT,
538ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, IPW_MAX_NSEG, MCLBYTES, 0,
539ceaec73dSDamien Bergamini 	    NULL, NULL, &sc->txbuf_dmat);
540ceaec73dSDamien Bergamini 	if (error != 0) {
541ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create tx DMA tag\n");
542ceaec73dSDamien Bergamini 		goto fail;
543ceaec73dSDamien Bergamini 	}
544ceaec73dSDamien Bergamini 
545ceaec73dSDamien Bergamini 	SLIST_INIT(&sc->free_sbuf);
546ceaec73dSDamien Bergamini 	for (i = 0; i < IPW_NDATA; i++) {
547ceaec73dSDamien Bergamini 		sbuf = &sc->tx_sbuf_list[i];
548ceaec73dSDamien Bergamini 		error = bus_dmamap_create(sc->txbuf_dmat, 0, &sbuf->map);
549ceaec73dSDamien Bergamini 		if (error != 0) {
550ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
551ceaec73dSDamien Bergamini 			    "could not create tx DMA map\n");
552ceaec73dSDamien Bergamini 			goto fail;
553ceaec73dSDamien Bergamini 		}
554ceaec73dSDamien Bergamini 		SLIST_INSERT_HEAD(&sc->free_sbuf, sbuf, next);
555ceaec73dSDamien Bergamini 	}
556ceaec73dSDamien Bergamini 
557ceaec73dSDamien Bergamini 	/*
558ceaec73dSDamien Bergamini 	 * Initialize tx ring.
559ceaec73dSDamien Bergamini 	 */
560ceaec73dSDamien Bergamini 	for (i = 0; i < IPW_NTBD; i++) {
561ceaec73dSDamien Bergamini 		sbd = &sc->stbd_list[i];
562ceaec73dSDamien Bergamini 		sbd->bd = &sc->tbd_list[i];
563ceaec73dSDamien Bergamini 		sbd->type = IPW_SBD_TYPE_NOASSOC;
564ceaec73dSDamien Bergamini 	}
565ceaec73dSDamien Bergamini 
566ceaec73dSDamien Bergamini 	/*
567ceaec73dSDamien Bergamini 	 * Pre-allocate rx buffers and DMA maps.
568ceaec73dSDamien Bergamini 	 */
569ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT,
57069e2ffe6SDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, 1, MCLBYTES, 0, NULL,
57169e2ffe6SDamien Bergamini 	    NULL, &sc->rxbuf_dmat);
572ceaec73dSDamien Bergamini 	if (error != 0) {
573ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create rx DMA tag\n");
574ceaec73dSDamien Bergamini 		goto fail;
575ceaec73dSDamien Bergamini 	}
576ceaec73dSDamien Bergamini 
577ceaec73dSDamien Bergamini 	for (i = 0; i < IPW_NRBD; i++) {
578ceaec73dSDamien Bergamini 		sbd = &sc->srbd_list[i];
579ceaec73dSDamien Bergamini 		sbuf = &sc->rx_sbuf_list[i];
580ceaec73dSDamien Bergamini 		sbd->bd = &sc->rbd_list[i];
581ceaec73dSDamien Bergamini 
582ceaec73dSDamien Bergamini 		sbuf->m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR);
583ceaec73dSDamien Bergamini 		if (sbuf->m == NULL) {
584ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
585ceaec73dSDamien Bergamini 			    "could not allocate rx mbuf\n");
586ceaec73dSDamien Bergamini 			error = ENOMEM;
587ceaec73dSDamien Bergamini 			goto fail;
588ceaec73dSDamien Bergamini 		}
589ceaec73dSDamien Bergamini 
590ceaec73dSDamien Bergamini 		error = bus_dmamap_create(sc->rxbuf_dmat, 0, &sbuf->map);
591ceaec73dSDamien Bergamini 		if (error != 0) {
592ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
593ceaec73dSDamien Bergamini 			    "could not create rx DMA map\n");
594ceaec73dSDamien Bergamini 			goto fail;
595ceaec73dSDamien Bergamini 		}
596ceaec73dSDamien Bergamini 
597ceaec73dSDamien Bergamini 		error = bus_dmamap_load(sc->rxbuf_dmat, sbuf->map,
598ceaec73dSDamien Bergamini 		    mtod(sbuf->m, void *), MCLBYTES, ipw_dma_map_addr,
599ceaec73dSDamien Bergamini 		    &physaddr, 0);
600ceaec73dSDamien Bergamini 		if (error != 0) {
601ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
602ceaec73dSDamien Bergamini 			    "could not map rx DMA memory\n");
603ceaec73dSDamien Bergamini 			goto fail;
604ceaec73dSDamien Bergamini 		}
605ceaec73dSDamien Bergamini 
606ceaec73dSDamien Bergamini 		sbd->type = IPW_SBD_TYPE_DATA;
607ceaec73dSDamien Bergamini 		sbd->priv = sbuf;
608ceaec73dSDamien Bergamini 		sbd->bd->physaddr = htole32(physaddr);
609ceaec73dSDamien Bergamini 		sbd->bd->len = htole32(MCLBYTES);
610ceaec73dSDamien Bergamini 	}
611ceaec73dSDamien Bergamini 
612ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->rbd_dmat, sc->rbd_map, BUS_DMASYNC_PREWRITE);
613ceaec73dSDamien Bergamini 
614ceaec73dSDamien Bergamini 	return 0;
615ceaec73dSDamien Bergamini 
616ceaec73dSDamien Bergamini fail:	ipw_release(sc);
617ceaec73dSDamien Bergamini 	return error;
618ceaec73dSDamien Bergamini }
619ceaec73dSDamien Bergamini 
620ceaec73dSDamien Bergamini static void
621ceaec73dSDamien Bergamini ipw_release(struct ipw_softc *sc)
622ceaec73dSDamien Bergamini {
623ceaec73dSDamien Bergamini 	struct ipw_soft_buf *sbuf;
624ceaec73dSDamien Bergamini 	int i;
625ceaec73dSDamien Bergamini 
626ceaec73dSDamien Bergamini 	if (sc->tbd_dmat != NULL) {
627ceaec73dSDamien Bergamini 		if (sc->stbd_list != NULL) {
628ceaec73dSDamien Bergamini 			bus_dmamap_unload(sc->tbd_dmat, sc->tbd_map);
629ceaec73dSDamien Bergamini 			bus_dmamem_free(sc->tbd_dmat, sc->tbd_list,
630ceaec73dSDamien Bergamini 			    sc->tbd_map);
631ceaec73dSDamien Bergamini 		}
632ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(sc->tbd_dmat);
633ceaec73dSDamien Bergamini 	}
634ceaec73dSDamien Bergamini 
635ceaec73dSDamien Bergamini 	if (sc->rbd_dmat != NULL) {
636ceaec73dSDamien Bergamini 		if (sc->rbd_list != NULL) {
637ceaec73dSDamien Bergamini 			bus_dmamap_unload(sc->rbd_dmat, sc->rbd_map);
638ceaec73dSDamien Bergamini 			bus_dmamem_free(sc->rbd_dmat, sc->rbd_list,
639ceaec73dSDamien Bergamini 			    sc->rbd_map);
640ceaec73dSDamien Bergamini 		}
641ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(sc->rbd_dmat);
642ceaec73dSDamien Bergamini 	}
643ceaec73dSDamien Bergamini 
644ceaec73dSDamien Bergamini 	if (sc->status_dmat != NULL) {
645ceaec73dSDamien Bergamini 		if (sc->status_list != NULL) {
646ceaec73dSDamien Bergamini 			bus_dmamap_unload(sc->status_dmat, sc->status_map);
647ceaec73dSDamien Bergamini 			bus_dmamem_free(sc->status_dmat, sc->status_list,
648ceaec73dSDamien Bergamini 			    sc->status_map);
649ceaec73dSDamien Bergamini 		}
650ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(sc->status_dmat);
651ceaec73dSDamien Bergamini 	}
652ceaec73dSDamien Bergamini 
653ceaec73dSDamien Bergamini 	for (i = 0; i < IPW_NTBD; i++)
654ceaec73dSDamien Bergamini 		ipw_release_sbd(sc, &sc->stbd_list[i]);
655ceaec73dSDamien Bergamini 
656ceaec73dSDamien Bergamini 	if (sc->cmd_dmat != NULL) {
657ceaec73dSDamien Bergamini 		bus_dmamap_destroy(sc->cmd_dmat, sc->cmd_map);
658ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(sc->cmd_dmat);
659ceaec73dSDamien Bergamini 	}
660ceaec73dSDamien Bergamini 
661ceaec73dSDamien Bergamini 	if (sc->hdr_dmat != NULL) {
662ceaec73dSDamien Bergamini 		for (i = 0; i < IPW_NDATA; i++)
663ceaec73dSDamien Bergamini 			bus_dmamap_destroy(sc->hdr_dmat, sc->shdr_list[i].map);
664ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(sc->hdr_dmat);
665ceaec73dSDamien Bergamini 	}
666ceaec73dSDamien Bergamini 
667ceaec73dSDamien Bergamini 	if (sc->txbuf_dmat != NULL) {
668ceaec73dSDamien Bergamini 		for (i = 0; i < IPW_NDATA; i++) {
669ceaec73dSDamien Bergamini 			bus_dmamap_destroy(sc->txbuf_dmat,
670ceaec73dSDamien Bergamini 			    sc->tx_sbuf_list[i].map);
671ceaec73dSDamien Bergamini 		}
672ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(sc->txbuf_dmat);
673ceaec73dSDamien Bergamini 	}
674ceaec73dSDamien Bergamini 
675ceaec73dSDamien Bergamini 	if (sc->rxbuf_dmat != NULL) {
676ceaec73dSDamien Bergamini 		for (i = 0; i < IPW_NRBD; i++) {
677ceaec73dSDamien Bergamini 			sbuf = &sc->rx_sbuf_list[i];
678ceaec73dSDamien Bergamini 			if (sbuf->m != NULL) {
679ceaec73dSDamien Bergamini 				bus_dmamap_sync(sc->rxbuf_dmat, sbuf->map,
680ceaec73dSDamien Bergamini 				    BUS_DMASYNC_POSTREAD);
681ceaec73dSDamien Bergamini 				bus_dmamap_unload(sc->rxbuf_dmat, sbuf->map);
682ceaec73dSDamien Bergamini 				m_freem(sbuf->m);
683ceaec73dSDamien Bergamini 			}
684ceaec73dSDamien Bergamini 			bus_dmamap_destroy(sc->rxbuf_dmat, sbuf->map);
685ceaec73dSDamien Bergamini 		}
686ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(sc->rxbuf_dmat);
687ceaec73dSDamien Bergamini 	}
688ceaec73dSDamien Bergamini }
689ceaec73dSDamien Bergamini 
690ceaec73dSDamien Bergamini static int
691ceaec73dSDamien Bergamini ipw_shutdown(device_t dev)
692ceaec73dSDamien Bergamini {
693ceaec73dSDamien Bergamini 	struct ipw_softc *sc = device_get_softc(dev);
694ceaec73dSDamien Bergamini 
695ceaec73dSDamien Bergamini 	ipw_stop(sc);
696ceaec73dSDamien Bergamini 
697ceaec73dSDamien Bergamini 	return 0;
698ceaec73dSDamien Bergamini }
699ceaec73dSDamien Bergamini 
700ceaec73dSDamien Bergamini static int
701ceaec73dSDamien Bergamini ipw_suspend(device_t dev)
702ceaec73dSDamien Bergamini {
703ceaec73dSDamien Bergamini 	struct ipw_softc *sc = device_get_softc(dev);
704ceaec73dSDamien Bergamini 
705ceaec73dSDamien Bergamini 	ipw_stop(sc);
706ceaec73dSDamien Bergamini 
707ceaec73dSDamien Bergamini 	return 0;
708ceaec73dSDamien Bergamini }
709ceaec73dSDamien Bergamini 
710ceaec73dSDamien Bergamini static int
711ceaec73dSDamien Bergamini ipw_resume(device_t dev)
712ceaec73dSDamien Bergamini {
713ceaec73dSDamien Bergamini 	struct ipw_softc *sc = device_get_softc(dev);
714ceaec73dSDamien Bergamini 	struct ifnet *ifp = sc->sc_ic.ic_ifp;
715ceaec73dSDamien Bergamini 
71684ca7670SDamien Bergamini 	mtx_lock(&sc->sc_mtx);
717ceaec73dSDamien Bergamini 
7180e22d2c5SDamien Bergamini 	pci_write_config(dev, 0x41, 0, 1);
7190e22d2c5SDamien Bergamini 
720ceaec73dSDamien Bergamini 	if (ifp->if_flags & IFF_UP) {
721ceaec73dSDamien Bergamini 		ifp->if_init(ifp->if_softc);
72213f4c340SRobert Watson 		if (ifp->if_drv_flags & IFF_DRV_RUNNING)
723ceaec73dSDamien Bergamini 			ifp->if_start(ifp);
724ceaec73dSDamien Bergamini 	}
725ceaec73dSDamien Bergamini 
72684ca7670SDamien Bergamini 	mtx_unlock(&sc->sc_mtx);
727ceaec73dSDamien Bergamini 
728ceaec73dSDamien Bergamini 	return 0;
729ceaec73dSDamien Bergamini }
730ceaec73dSDamien Bergamini 
731ceaec73dSDamien Bergamini static int
732ceaec73dSDamien Bergamini ipw_media_change(struct ifnet *ifp)
733ceaec73dSDamien Bergamini {
734ceaec73dSDamien Bergamini 	struct ipw_softc *sc = ifp->if_softc;
735ceaec73dSDamien Bergamini 	int error;
736ceaec73dSDamien Bergamini 
73784ca7670SDamien Bergamini 	mtx_lock(&sc->sc_mtx);
738ceaec73dSDamien Bergamini 
739ceaec73dSDamien Bergamini 	error = ieee80211_media_change(ifp);
740ceaec73dSDamien Bergamini 	if (error != ENETRESET) {
74184ca7670SDamien Bergamini 		mtx_unlock(&sc->sc_mtx);
742ceaec73dSDamien Bergamini 		return error;
743ceaec73dSDamien Bergamini 	}
744ceaec73dSDamien Bergamini 
74513f4c340SRobert Watson 	if ((ifp->if_flags & IFF_UP) && (ifp->if_drv_flags & IFF_DRV_RUNNING))
746ceaec73dSDamien Bergamini 		ipw_init(sc);
747ceaec73dSDamien Bergamini 
74884ca7670SDamien Bergamini 	mtx_unlock(&sc->sc_mtx);
749ceaec73dSDamien Bergamini 
750ceaec73dSDamien Bergamini 	return 0;
751ceaec73dSDamien Bergamini }
752ceaec73dSDamien Bergamini 
753ceaec73dSDamien Bergamini /*
75484ca7670SDamien Bergamini  * The firmware automatically adapts the transmit speed. We report its current
75584ca7670SDamien Bergamini  * value here.
756ceaec73dSDamien Bergamini  */
757ceaec73dSDamien Bergamini static void
758ceaec73dSDamien Bergamini ipw_media_status(struct ifnet *ifp, struct ifmediareq *imr)
759ceaec73dSDamien Bergamini {
760ceaec73dSDamien Bergamini #define N(a)	(sizeof (a) / sizeof (a[0]))
761ceaec73dSDamien Bergamini 	struct ipw_softc *sc = ifp->if_softc;
762ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
763ceaec73dSDamien Bergamini 	static const struct {
764ceaec73dSDamien Bergamini 		uint32_t	val;
765ceaec73dSDamien Bergamini 		int		rate;
766ceaec73dSDamien Bergamini 	} rates[] = {
767ceaec73dSDamien Bergamini 		{ IPW_RATE_DS1,   2 },
768ceaec73dSDamien Bergamini 		{ IPW_RATE_DS2,   4 },
769ceaec73dSDamien Bergamini 		{ IPW_RATE_DS5,  11 },
770ceaec73dSDamien Bergamini 		{ IPW_RATE_DS11, 22 },
771ceaec73dSDamien Bergamini 	};
772ceaec73dSDamien Bergamini 	uint32_t val;
773ceaec73dSDamien Bergamini 	int rate, i;
774ceaec73dSDamien Bergamini 
775ceaec73dSDamien Bergamini 	imr->ifm_status = IFM_AVALID;
776ceaec73dSDamien Bergamini 	imr->ifm_active = IFM_IEEE80211;
777ceaec73dSDamien Bergamini 	if (ic->ic_state == IEEE80211_S_RUN)
778ceaec73dSDamien Bergamini 		imr->ifm_status |= IFM_ACTIVE;
779ceaec73dSDamien Bergamini 
780ceaec73dSDamien Bergamini 	/* read current transmission rate from adapter */
781ceaec73dSDamien Bergamini 	val = ipw_read_table1(sc, IPW_INFO_CURRENT_TX_RATE) & 0xf;
782ceaec73dSDamien Bergamini 
783ceaec73dSDamien Bergamini 	/* convert ipw rate to 802.11 rate */
784ceaec73dSDamien Bergamini 	for (i = 0; i < N(rates) && rates[i].val != val; i++);
785ceaec73dSDamien Bergamini 	rate = (i < N(rates)) ? rates[i].rate : 0;
786ceaec73dSDamien Bergamini 
787ceaec73dSDamien Bergamini 	imr->ifm_active |= IFM_IEEE80211_11B;
788ceaec73dSDamien Bergamini 	imr->ifm_active |= ieee80211_rate2media(ic, rate, IEEE80211_MODE_11B);
789ceaec73dSDamien Bergamini 	switch (ic->ic_opmode) {
790ceaec73dSDamien Bergamini 	case IEEE80211_M_STA:
791ceaec73dSDamien Bergamini 		break;
792ceaec73dSDamien Bergamini 
793ceaec73dSDamien Bergamini 	case IEEE80211_M_IBSS:
794ceaec73dSDamien Bergamini 		imr->ifm_active |= IFM_IEEE80211_IBSS;
795ceaec73dSDamien Bergamini 		break;
796ceaec73dSDamien Bergamini 
797ceaec73dSDamien Bergamini 	case IEEE80211_M_MONITOR:
798ceaec73dSDamien Bergamini 		imr->ifm_active |= IFM_IEEE80211_MONITOR;
799ceaec73dSDamien Bergamini 		break;
800ceaec73dSDamien Bergamini 
801ceaec73dSDamien Bergamini 	case IEEE80211_M_AHDEMO:
802ceaec73dSDamien Bergamini 	case IEEE80211_M_HOSTAP:
803ceaec73dSDamien Bergamini 		/* should not get there */
804ceaec73dSDamien Bergamini 		break;
805ceaec73dSDamien Bergamini 	}
806ceaec73dSDamien Bergamini #undef N
807ceaec73dSDamien Bergamini }
808ceaec73dSDamien Bergamini 
809ceaec73dSDamien Bergamini static int
810ceaec73dSDamien Bergamini ipw_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
811ceaec73dSDamien Bergamini {
812ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
813ceaec73dSDamien Bergamini 	struct ipw_softc *sc = ifp->if_softc;
814ceaec73dSDamien Bergamini 	struct ieee80211_node *ni;
815ceaec73dSDamien Bergamini 	uint8_t macaddr[IEEE80211_ADDR_LEN];
816ceaec73dSDamien Bergamini 	uint32_t len;
817ceaec73dSDamien Bergamini 
818ceaec73dSDamien Bergamini 	switch (nstate) {
819ceaec73dSDamien Bergamini 	case IEEE80211_S_RUN:
820ceaec73dSDamien Bergamini 		DELAY(200); /* firmware needs a short delay here */
821ceaec73dSDamien Bergamini 
822ceaec73dSDamien Bergamini 		len = IEEE80211_ADDR_LEN;
823ceaec73dSDamien Bergamini 		ipw_read_table2(sc, IPW_INFO_CURRENT_BSSID, macaddr, &len);
824ceaec73dSDamien Bergamini 
825ceaec73dSDamien Bergamini 		ni = ieee80211_find_node(&ic->ic_scan, macaddr);
826ceaec73dSDamien Bergamini 		if (ni == NULL)
827ceaec73dSDamien Bergamini 			break;
828ceaec73dSDamien Bergamini 
829ceaec73dSDamien Bergamini 		ieee80211_ref_node(ni);
830ceaec73dSDamien Bergamini 		ieee80211_sta_join(ic, ni);
831e4918ecdSSam Leffler 		ieee80211_node_authorize(ni);
832ceaec73dSDamien Bergamini 
833ceaec73dSDamien Bergamini 		if (ic->ic_opmode == IEEE80211_M_STA)
834ceaec73dSDamien Bergamini 			ieee80211_notify_node_join(ic, ni, 1);
835ceaec73dSDamien Bergamini 		break;
836ceaec73dSDamien Bergamini 
837ceaec73dSDamien Bergamini 	case IEEE80211_S_INIT:
838ceaec73dSDamien Bergamini 	case IEEE80211_S_SCAN:
839ceaec73dSDamien Bergamini 	case IEEE80211_S_AUTH:
840ceaec73dSDamien Bergamini 	case IEEE80211_S_ASSOC:
841ceaec73dSDamien Bergamini 		break;
842ceaec73dSDamien Bergamini 	}
843ceaec73dSDamien Bergamini 
844ceaec73dSDamien Bergamini 	ic->ic_state = nstate;
84584ca7670SDamien Bergamini 
846ceaec73dSDamien Bergamini 	return 0;
847ceaec73dSDamien Bergamini }
848ceaec73dSDamien Bergamini 
849ceaec73dSDamien Bergamini /*
850ceaec73dSDamien Bergamini  * Read 16 bits at address 'addr' from the serial EEPROM.
851ceaec73dSDamien Bergamini  */
852ceaec73dSDamien Bergamini static uint16_t
853ceaec73dSDamien Bergamini ipw_read_prom_word(struct ipw_softc *sc, uint8_t addr)
854ceaec73dSDamien Bergamini {
855ceaec73dSDamien Bergamini 	uint32_t tmp;
856ceaec73dSDamien Bergamini 	uint16_t val;
857ceaec73dSDamien Bergamini 	int n;
858ceaec73dSDamien Bergamini 
859ceaec73dSDamien Bergamini 	/* clock C once before the first command */
860ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, 0);
861ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, IPW_EEPROM_S);
862ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, IPW_EEPROM_S | IPW_EEPROM_C);
863ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, IPW_EEPROM_S);
864ceaec73dSDamien Bergamini 
865ceaec73dSDamien Bergamini 	/* write start bit (1) */
866ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, IPW_EEPROM_S | IPW_EEPROM_D);
867ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, IPW_EEPROM_S | IPW_EEPROM_D | IPW_EEPROM_C);
868ceaec73dSDamien Bergamini 
869ceaec73dSDamien Bergamini 	/* write READ opcode (10) */
870ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, IPW_EEPROM_S | IPW_EEPROM_D);
871ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, IPW_EEPROM_S | IPW_EEPROM_D | IPW_EEPROM_C);
872ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, IPW_EEPROM_S);
873ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, IPW_EEPROM_S | IPW_EEPROM_C);
874ceaec73dSDamien Bergamini 
875ceaec73dSDamien Bergamini 	/* write address A7-A0 */
876ceaec73dSDamien Bergamini 	for (n = 7; n >= 0; n--) {
877ceaec73dSDamien Bergamini 		IPW_EEPROM_CTL(sc, IPW_EEPROM_S |
878ceaec73dSDamien Bergamini 		    (((addr >> n) & 1) << IPW_EEPROM_SHIFT_D));
879ceaec73dSDamien Bergamini 		IPW_EEPROM_CTL(sc, IPW_EEPROM_S |
880ceaec73dSDamien Bergamini 		    (((addr >> n) & 1) << IPW_EEPROM_SHIFT_D) | IPW_EEPROM_C);
881ceaec73dSDamien Bergamini 	}
882ceaec73dSDamien Bergamini 
883ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, IPW_EEPROM_S);
884ceaec73dSDamien Bergamini 
885ceaec73dSDamien Bergamini 	/* read data Q15-Q0 */
886ceaec73dSDamien Bergamini 	val = 0;
887ceaec73dSDamien Bergamini 	for (n = 15; n >= 0; n--) {
888ceaec73dSDamien Bergamini 		IPW_EEPROM_CTL(sc, IPW_EEPROM_S | IPW_EEPROM_C);
889ceaec73dSDamien Bergamini 		IPW_EEPROM_CTL(sc, IPW_EEPROM_S);
890ceaec73dSDamien Bergamini 		tmp = MEM_READ_4(sc, IPW_MEM_EEPROM_CTL);
891ceaec73dSDamien Bergamini 		val |= ((tmp & IPW_EEPROM_Q) >> IPW_EEPROM_SHIFT_Q) << n;
892ceaec73dSDamien Bergamini 	}
893ceaec73dSDamien Bergamini 
894ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, 0);
895ceaec73dSDamien Bergamini 
896ceaec73dSDamien Bergamini 	/* clear Chip Select and clock C */
897ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, IPW_EEPROM_S);
898ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, 0);
899ceaec73dSDamien Bergamini 	IPW_EEPROM_CTL(sc, IPW_EEPROM_C);
900ceaec73dSDamien Bergamini 
901ceaec73dSDamien Bergamini 	return le16toh(val);
902ceaec73dSDamien Bergamini }
903ceaec73dSDamien Bergamini 
904ceaec73dSDamien Bergamini static void
905ceaec73dSDamien Bergamini ipw_command_intr(struct ipw_softc *sc, struct ipw_soft_buf *sbuf)
906ceaec73dSDamien Bergamini {
907ceaec73dSDamien Bergamini 	struct ipw_cmd *cmd;
908ceaec73dSDamien Bergamini 
909ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->rxbuf_dmat, sbuf->map, BUS_DMASYNC_POSTREAD);
910ceaec73dSDamien Bergamini 
911ceaec73dSDamien Bergamini 	cmd = mtod(sbuf->m, struct ipw_cmd *);
912ceaec73dSDamien Bergamini 
913ceaec73dSDamien Bergamini 	DPRINTFN(2, ("cmd ack'ed (%u, %u, %u, %u, %u)\n", le32toh(cmd->type),
914ceaec73dSDamien Bergamini 	    le32toh(cmd->subtype), le32toh(cmd->seq), le32toh(cmd->len),
915ceaec73dSDamien Bergamini 	    le32toh(cmd->status)));
916ceaec73dSDamien Bergamini 
917ceaec73dSDamien Bergamini 	wakeup(sc);
918ceaec73dSDamien Bergamini }
919ceaec73dSDamien Bergamini 
920ceaec73dSDamien Bergamini static void
921ceaec73dSDamien Bergamini ipw_newstate_intr(struct ipw_softc *sc, struct ipw_soft_buf *sbuf)
922ceaec73dSDamien Bergamini {
923ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
924ceaec73dSDamien Bergamini 	uint32_t state;
925ceaec73dSDamien Bergamini 
926ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->rxbuf_dmat, sbuf->map, BUS_DMASYNC_POSTREAD);
927ceaec73dSDamien Bergamini 
928ceaec73dSDamien Bergamini 	state = le32toh(*mtod(sbuf->m, uint32_t *));
929ceaec73dSDamien Bergamini 
930ceaec73dSDamien Bergamini 	DPRINTFN(2, ("entering state %u\n", state));
931ceaec73dSDamien Bergamini 
932ceaec73dSDamien Bergamini 	switch (state) {
933ceaec73dSDamien Bergamini 	case IPW_STATE_ASSOCIATED:
934ceaec73dSDamien Bergamini 		ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
935ceaec73dSDamien Bergamini 		break;
936ceaec73dSDamien Bergamini 
937ceaec73dSDamien Bergamini 	case IPW_STATE_SCANNING:
938ceaec73dSDamien Bergamini 		/* don't leave run state on background scan */
939ceaec73dSDamien Bergamini 		if (ic->ic_state != IEEE80211_S_RUN)
940ceaec73dSDamien Bergamini 			ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
941ceaec73dSDamien Bergamini 
942ceaec73dSDamien Bergamini 		ic->ic_flags |= IEEE80211_F_SCAN;
943ceaec73dSDamien Bergamini 		break;
944ceaec73dSDamien Bergamini 
945ceaec73dSDamien Bergamini 	case IPW_STATE_SCAN_COMPLETE:
946ceaec73dSDamien Bergamini 		ieee80211_notify_scan_done(ic);
947ceaec73dSDamien Bergamini 		ic->ic_flags &= ~IEEE80211_F_SCAN;
948ceaec73dSDamien Bergamini 		break;
949ceaec73dSDamien Bergamini 
950ceaec73dSDamien Bergamini 	case IPW_STATE_ASSOCIATION_LOST:
951ceaec73dSDamien Bergamini 		ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
952ceaec73dSDamien Bergamini 		break;
953ceaec73dSDamien Bergamini 
954ceaec73dSDamien Bergamini 	case IPW_STATE_RADIO_DISABLED:
955ceaec73dSDamien Bergamini 		ic->ic_ifp->if_flags &= ~IFF_UP;
956ceaec73dSDamien Bergamini 		ipw_stop(sc);
957ceaec73dSDamien Bergamini 		break;
958ceaec73dSDamien Bergamini 	}
959ceaec73dSDamien Bergamini }
960ceaec73dSDamien Bergamini 
961ceaec73dSDamien Bergamini /*
962ceaec73dSDamien Bergamini  * XXX: Hack to set the current channel to the value advertised in beacons or
963ceaec73dSDamien Bergamini  * probe responses. Only used during AP detection.
964ceaec73dSDamien Bergamini  */
965ceaec73dSDamien Bergamini static void
966ceaec73dSDamien Bergamini ipw_fix_channel(struct ieee80211com *ic, struct mbuf *m)
967ceaec73dSDamien Bergamini {
968ceaec73dSDamien Bergamini 	struct ieee80211_frame *wh;
969ceaec73dSDamien Bergamini 	uint8_t subtype;
970ceaec73dSDamien Bergamini 	uint8_t *frm, *efrm;
971ceaec73dSDamien Bergamini 
972ceaec73dSDamien Bergamini 	wh = mtod(m, struct ieee80211_frame *);
973ceaec73dSDamien Bergamini 
974ceaec73dSDamien Bergamini 	if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) != IEEE80211_FC0_TYPE_MGT)
975ceaec73dSDamien Bergamini 		return;
976ceaec73dSDamien Bergamini 
977ceaec73dSDamien Bergamini 	subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;
978ceaec73dSDamien Bergamini 
979ceaec73dSDamien Bergamini 	if (subtype != IEEE80211_FC0_SUBTYPE_BEACON &&
980ceaec73dSDamien Bergamini 	    subtype != IEEE80211_FC0_SUBTYPE_PROBE_RESP)
981ceaec73dSDamien Bergamini 		return;
982ceaec73dSDamien Bergamini 
983ceaec73dSDamien Bergamini 	frm = (uint8_t *)(wh + 1);
984ceaec73dSDamien Bergamini 	efrm = mtod(m, uint8_t *) + m->m_len;
985ceaec73dSDamien Bergamini 
986ceaec73dSDamien Bergamini 	frm += 12;	/* skip tstamp, bintval and capinfo fields */
987ceaec73dSDamien Bergamini 	while (frm < efrm) {
988ceaec73dSDamien Bergamini 		if (*frm == IEEE80211_ELEMID_DSPARMS)
989ceaec73dSDamien Bergamini #if IEEE80211_CHAN_MAX < 255
990ceaec73dSDamien Bergamini 		if (frm[2] <= IEEE80211_CHAN_MAX)
991ceaec73dSDamien Bergamini #endif
992b5c99415SSam Leffler 			ic->ic_curchan = &ic->ic_channels[frm[2]];
993ceaec73dSDamien Bergamini 
994ceaec73dSDamien Bergamini 		frm += frm[1] + 2;
995ceaec73dSDamien Bergamini 	}
996ceaec73dSDamien Bergamini }
997ceaec73dSDamien Bergamini 
998ceaec73dSDamien Bergamini static void
999ceaec73dSDamien Bergamini ipw_data_intr(struct ipw_softc *sc, struct ipw_status *status,
1000ceaec73dSDamien Bergamini     struct ipw_soft_bd *sbd, struct ipw_soft_buf *sbuf)
1001ceaec73dSDamien Bergamini {
1002ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1003ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
10044c4102ecSDamien Bergamini 	struct mbuf *mnew, *m;
1005ceaec73dSDamien Bergamini 	struct ieee80211_frame *wh;
1006ceaec73dSDamien Bergamini 	struct ieee80211_node *ni;
1007ceaec73dSDamien Bergamini 	bus_addr_t physaddr;
1008ceaec73dSDamien Bergamini 	int error;
1009ceaec73dSDamien Bergamini 
10104c4102ecSDamien Bergamini 	DPRINTFN(5, ("received frame len=%u, rssi=%u\n", le32toh(status->len),
10114c4102ecSDamien Bergamini 	    status->rssi));
10124c4102ecSDamien Bergamini 
101309137879SDamien Bergamini 	if (le32toh(status->len) < sizeof (struct ieee80211_frame_min) ||
101409137879SDamien Bergamini 	    le32toh(status->len) > MCLBYTES)
101509137879SDamien Bergamini 		return;
101609137879SDamien Bergamini 
10174c4102ecSDamien Bergamini 	/*
10184c4102ecSDamien Bergamini 	 * Try to allocate a new mbuf for this ring element and load it before
10194c4102ecSDamien Bergamini 	 * processing the current mbuf. If the ring element cannot be loaded,
10204c4102ecSDamien Bergamini 	 * drop the received packet and reuse the old mbuf. In the unlikely
10214c4102ecSDamien Bergamini 	 * case that the old mbuf can't be reloaded either, explicitly panic.
10224c4102ecSDamien Bergamini 	 */
10234c4102ecSDamien Bergamini 	mnew = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR);
10244c4102ecSDamien Bergamini 	if (mnew == NULL) {
10254c4102ecSDamien Bergamini 		ifp->if_ierrors++;
10264c4102ecSDamien Bergamini 		return;
10274c4102ecSDamien Bergamini 	}
10284c4102ecSDamien Bergamini 
1029ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->rxbuf_dmat, sbuf->map, BUS_DMASYNC_POSTREAD);
1030ceaec73dSDamien Bergamini 	bus_dmamap_unload(sc->rxbuf_dmat, sbuf->map);
1031ceaec73dSDamien Bergamini 
10324c4102ecSDamien Bergamini 	error = bus_dmamap_load(sc->rxbuf_dmat, sbuf->map, mtod(mnew, void *),
10334c4102ecSDamien Bergamini 	    MCLBYTES, ipw_dma_map_addr, &physaddr, 0);
10344c4102ecSDamien Bergamini 	if (error != 0) {
10354c4102ecSDamien Bergamini 		m_freem(mnew);
10364c4102ecSDamien Bergamini 
10374c4102ecSDamien Bergamini 		/* try to reload the old mbuf */
10384c4102ecSDamien Bergamini 		error = bus_dmamap_load(sc->rxbuf_dmat, sbuf->map,
10394c4102ecSDamien Bergamini 		    mtod(sbuf->m, void *), MCLBYTES, ipw_dma_map_addr,
10404c4102ecSDamien Bergamini 		    &physaddr, 0);
10414c4102ecSDamien Bergamini 		if (error != 0) {
10424c4102ecSDamien Bergamini 			/* very unlikely that it will fail... */
10434c4102ecSDamien Bergamini 			panic("%s: could not load old rx mbuf",
10444c4102ecSDamien Bergamini 			    device_get_name(sc->sc_dev));
10454c4102ecSDamien Bergamini 		}
10464c4102ecSDamien Bergamini 		ifp->if_ierrors++;
10474c4102ecSDamien Bergamini 		return;
10484c4102ecSDamien Bergamini 	}
10494c4102ecSDamien Bergamini 
10504c4102ecSDamien Bergamini 	/*
10514c4102ecSDamien Bergamini 	 * New mbuf successfully loaded, update Rx ring and continue
10524c4102ecSDamien Bergamini 	 * processing.
10534c4102ecSDamien Bergamini 	 */
1054ceaec73dSDamien Bergamini 	m = sbuf->m;
10554c4102ecSDamien Bergamini 	sbuf->m = mnew;
10564c4102ecSDamien Bergamini 	sbd->bd->physaddr = htole32(physaddr);
10574c4102ecSDamien Bergamini 
10584c4102ecSDamien Bergamini 	/* finalize mbuf */
1059ceaec73dSDamien Bergamini 	m->m_pkthdr.rcvif = ifp;
1060ceaec73dSDamien Bergamini 	m->m_pkthdr.len = m->m_len = le32toh(status->len);
1061ceaec73dSDamien Bergamini 
106216d878ccSChristian S.J. Peron 	if (bpf_peers_present(sc->sc_drvbpf)) {
1063ceaec73dSDamien Bergamini 		struct ipw_rx_radiotap_header *tap = &sc->sc_rxtap;
1064ceaec73dSDamien Bergamini 
1065ceaec73dSDamien Bergamini 		tap->wr_flags = 0;
1066ceaec73dSDamien Bergamini 		tap->wr_antsignal = status->rssi;
106784ca7670SDamien Bergamini 		tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq);
106884ca7670SDamien Bergamini 		tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags);
1069ceaec73dSDamien Bergamini 
1070ceaec73dSDamien Bergamini 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_rxtap_len, m);
1071ceaec73dSDamien Bergamini 	}
1072ceaec73dSDamien Bergamini 
1073ceaec73dSDamien Bergamini 	if (ic->ic_state == IEEE80211_S_SCAN)
1074ceaec73dSDamien Bergamini 		ipw_fix_channel(ic, m);
1075ceaec73dSDamien Bergamini 
1076ceaec73dSDamien Bergamini 	wh = mtod(m, struct ieee80211_frame *);
1077ceaec73dSDamien Bergamini 	ni = ieee80211_find_rxnode(ic, (struct ieee80211_frame_min *)wh);
1078ceaec73dSDamien Bergamini 
1079ceaec73dSDamien Bergamini 	/* send the frame to the 802.11 layer */
1080ceaec73dSDamien Bergamini 	ieee80211_input(ic, m, ni, status->rssi, 0);
1081ceaec73dSDamien Bergamini 
1082ceaec73dSDamien Bergamini 	/* node is no longer needed */
1083ceaec73dSDamien Bergamini 	ieee80211_free_node(ni);
1084ceaec73dSDamien Bergamini 
1085ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->rbd_dmat, sc->rbd_map, BUS_DMASYNC_PREWRITE);
1086ceaec73dSDamien Bergamini }
1087ceaec73dSDamien Bergamini 
1088ceaec73dSDamien Bergamini static void
1089ceaec73dSDamien Bergamini ipw_rx_intr(struct ipw_softc *sc)
1090ceaec73dSDamien Bergamini {
1091ceaec73dSDamien Bergamini 	struct ipw_status *status;
1092ceaec73dSDamien Bergamini 	struct ipw_soft_bd *sbd;
1093ceaec73dSDamien Bergamini 	struct ipw_soft_buf *sbuf;
1094ceaec73dSDamien Bergamini 	uint32_t r, i;
1095ceaec73dSDamien Bergamini 
1096ceaec73dSDamien Bergamini 	if (!(sc->flags & IPW_FLAG_FW_INITED))
1097ceaec73dSDamien Bergamini 		return;
1098ceaec73dSDamien Bergamini 
1099ceaec73dSDamien Bergamini 	r = CSR_READ_4(sc, IPW_CSR_RX_READ);
1100ceaec73dSDamien Bergamini 
1101ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->status_dmat, sc->status_map, BUS_DMASYNC_POSTREAD);
1102ceaec73dSDamien Bergamini 
1103ceaec73dSDamien Bergamini 	for (i = (sc->rxcur + 1) % IPW_NRBD; i != r; i = (i + 1) % IPW_NRBD) {
1104ceaec73dSDamien Bergamini 		status = &sc->status_list[i];
1105ceaec73dSDamien Bergamini 		sbd = &sc->srbd_list[i];
1106ceaec73dSDamien Bergamini 		sbuf = sbd->priv;
1107ceaec73dSDamien Bergamini 
1108ceaec73dSDamien Bergamini 		switch (le16toh(status->code) & 0xf) {
1109ceaec73dSDamien Bergamini 		case IPW_STATUS_CODE_COMMAND:
1110ceaec73dSDamien Bergamini 			ipw_command_intr(sc, sbuf);
1111ceaec73dSDamien Bergamini 			break;
1112ceaec73dSDamien Bergamini 
1113ceaec73dSDamien Bergamini 		case IPW_STATUS_CODE_NEWSTATE:
1114ceaec73dSDamien Bergamini 			ipw_newstate_intr(sc, sbuf);
1115ceaec73dSDamien Bergamini 			break;
1116ceaec73dSDamien Bergamini 
1117ceaec73dSDamien Bergamini 		case IPW_STATUS_CODE_DATA_802_3:
1118ceaec73dSDamien Bergamini 		case IPW_STATUS_CODE_DATA_802_11:
1119ceaec73dSDamien Bergamini 			ipw_data_intr(sc, status, sbd, sbuf);
1120ceaec73dSDamien Bergamini 			break;
1121ceaec73dSDamien Bergamini 
1122ceaec73dSDamien Bergamini 		case IPW_STATUS_CODE_NOTIFICATION:
1123ceaec73dSDamien Bergamini 			DPRINTFN(2, ("received notification\n"));
1124ceaec73dSDamien Bergamini 			break;
1125ceaec73dSDamien Bergamini 
1126ceaec73dSDamien Bergamini 		default:
1127ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev, "unknown status code %u\n",
1128ceaec73dSDamien Bergamini 			    le16toh(status->code));
1129ceaec73dSDamien Bergamini 		}
1130ceaec73dSDamien Bergamini 
1131ceaec73dSDamien Bergamini 		/* firmware was killed, stop processing received frames */
1132ceaec73dSDamien Bergamini 		if (!(sc->flags & IPW_FLAG_FW_INITED))
1133ceaec73dSDamien Bergamini 			return;
1134ceaec73dSDamien Bergamini 
1135ceaec73dSDamien Bergamini 		sbd->bd->flags = 0;
1136ceaec73dSDamien Bergamini 	}
1137ceaec73dSDamien Bergamini 
1138ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->rbd_dmat, sc->rbd_map, BUS_DMASYNC_PREWRITE);
1139ceaec73dSDamien Bergamini 
1140ceaec73dSDamien Bergamini 	/* kick the firmware */
1141ceaec73dSDamien Bergamini 	sc->rxcur = (r == 0) ? IPW_NRBD - 1 : r - 1;
1142ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_RX_WRITE, sc->rxcur);
1143ceaec73dSDamien Bergamini }
1144ceaec73dSDamien Bergamini 
1145ceaec73dSDamien Bergamini static void
1146ceaec73dSDamien Bergamini ipw_release_sbd(struct ipw_softc *sc, struct ipw_soft_bd *sbd)
1147ceaec73dSDamien Bergamini {
1148ceaec73dSDamien Bergamini 	struct ipw_soft_hdr *shdr;
1149ceaec73dSDamien Bergamini 	struct ipw_soft_buf *sbuf;
1150ceaec73dSDamien Bergamini 
1151ceaec73dSDamien Bergamini 	switch (sbd->type) {
1152ceaec73dSDamien Bergamini 	case IPW_SBD_TYPE_COMMAND:
1153ceaec73dSDamien Bergamini 		bus_dmamap_sync(sc->cmd_dmat, sc->cmd_map,
1154ceaec73dSDamien Bergamini 		    BUS_DMASYNC_POSTWRITE);
1155ceaec73dSDamien Bergamini 		bus_dmamap_unload(sc->cmd_dmat, sc->cmd_map);
1156ceaec73dSDamien Bergamini 		break;
1157ceaec73dSDamien Bergamini 
1158ceaec73dSDamien Bergamini 	case IPW_SBD_TYPE_HEADER:
1159ceaec73dSDamien Bergamini 		shdr = sbd->priv;
1160ceaec73dSDamien Bergamini 		bus_dmamap_sync(sc->hdr_dmat, shdr->map, BUS_DMASYNC_POSTWRITE);
1161ceaec73dSDamien Bergamini 		bus_dmamap_unload(sc->hdr_dmat, shdr->map);
1162ceaec73dSDamien Bergamini 		SLIST_INSERT_HEAD(&sc->free_shdr, shdr, next);
1163ceaec73dSDamien Bergamini 		break;
1164ceaec73dSDamien Bergamini 
1165ceaec73dSDamien Bergamini 	case IPW_SBD_TYPE_DATA:
1166ceaec73dSDamien Bergamini 		sbuf = sbd->priv;
1167ceaec73dSDamien Bergamini 		bus_dmamap_sync(sc->txbuf_dmat, sbuf->map,
1168ceaec73dSDamien Bergamini 		    BUS_DMASYNC_POSTWRITE);
1169ceaec73dSDamien Bergamini 		bus_dmamap_unload(sc->txbuf_dmat, sbuf->map);
1170ceaec73dSDamien Bergamini 		SLIST_INSERT_HEAD(&sc->free_sbuf, sbuf, next);
1171ceaec73dSDamien Bergamini 
1172ceaec73dSDamien Bergamini 		m_freem(sbuf->m);
1173ceaec73dSDamien Bergamini 		ieee80211_free_node(sbuf->ni);
1174ceaec73dSDamien Bergamini 
1175ceaec73dSDamien Bergamini 		sc->sc_tx_timer = 0;
1176ceaec73dSDamien Bergamini 		break;
1177ceaec73dSDamien Bergamini 	}
1178ceaec73dSDamien Bergamini 
1179ceaec73dSDamien Bergamini 	sbd->type = IPW_SBD_TYPE_NOASSOC;
1180ceaec73dSDamien Bergamini }
1181ceaec73dSDamien Bergamini 
1182ceaec73dSDamien Bergamini static void
1183ceaec73dSDamien Bergamini ipw_tx_intr(struct ipw_softc *sc)
1184ceaec73dSDamien Bergamini {
1185ceaec73dSDamien Bergamini 	struct ifnet *ifp = sc->sc_ic.ic_ifp;
1186ceaec73dSDamien Bergamini 	struct ipw_soft_bd *sbd;
1187ceaec73dSDamien Bergamini 	uint32_t r, i;
1188ceaec73dSDamien Bergamini 
1189ceaec73dSDamien Bergamini 	if (!(sc->flags & IPW_FLAG_FW_INITED))
1190ceaec73dSDamien Bergamini 		return;
1191ceaec73dSDamien Bergamini 
1192ceaec73dSDamien Bergamini 	r = CSR_READ_4(sc, IPW_CSR_TX_READ);
1193ceaec73dSDamien Bergamini 
1194ceaec73dSDamien Bergamini 	for (i = (sc->txold + 1) % IPW_NTBD; i != r; i = (i + 1) % IPW_NTBD) {
1195ceaec73dSDamien Bergamini 		sbd = &sc->stbd_list[i];
1196ceaec73dSDamien Bergamini 
1197ceaec73dSDamien Bergamini 		if (sbd->type == IPW_SBD_TYPE_DATA)
1198ceaec73dSDamien Bergamini 			ifp->if_opackets++;
1199ceaec73dSDamien Bergamini 
1200ceaec73dSDamien Bergamini 		ipw_release_sbd(sc, sbd);
1201ceaec73dSDamien Bergamini 		sc->txfree++;
1202ceaec73dSDamien Bergamini 	}
1203ceaec73dSDamien Bergamini 
1204ceaec73dSDamien Bergamini 	/* remember what the firmware has processed */
1205ceaec73dSDamien Bergamini 	sc->txold = (r == 0) ? IPW_NTBD - 1 : r - 1;
1206ceaec73dSDamien Bergamini 
120713f4c340SRobert Watson 	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1208ceaec73dSDamien Bergamini 	ipw_start(ifp);
1209ceaec73dSDamien Bergamini }
1210ceaec73dSDamien Bergamini 
1211ceaec73dSDamien Bergamini static void
1212ceaec73dSDamien Bergamini ipw_intr(void *arg)
1213ceaec73dSDamien Bergamini {
1214ceaec73dSDamien Bergamini 	struct ipw_softc *sc = arg;
1215ceaec73dSDamien Bergamini 	uint32_t r;
1216ceaec73dSDamien Bergamini 
121784ca7670SDamien Bergamini 	mtx_lock(&sc->sc_mtx);
1218ceaec73dSDamien Bergamini 
1219ceaec73dSDamien Bergamini 	if ((r = CSR_READ_4(sc, IPW_CSR_INTR)) == 0 || r == 0xffffffff) {
122084ca7670SDamien Bergamini 		mtx_unlock(&sc->sc_mtx);
1221ceaec73dSDamien Bergamini 		return;
1222ceaec73dSDamien Bergamini 	}
1223ceaec73dSDamien Bergamini 
1224ceaec73dSDamien Bergamini 	/* disable interrupts */
1225ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_INTR_MASK, 0);
1226ceaec73dSDamien Bergamini 
122784ca7670SDamien Bergamini 	/* acknowledge all interrupts */
122884ca7670SDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_INTR, r);
122984ca7670SDamien Bergamini 
1230ceaec73dSDamien Bergamini 	if (r & (IPW_INTR_FATAL_ERROR | IPW_INTR_PARITY_ERROR)) {
123184ca7670SDamien Bergamini 		device_printf(sc->sc_dev, "firmware error\n");
123284ca7670SDamien Bergamini 		taskqueue_enqueue_fast(taskqueue_fast, &sc->sc_init_task);
123384ca7670SDamien Bergamini 		r = 0;	/* don't process more interrupts */
1234ceaec73dSDamien Bergamini 	}
1235ceaec73dSDamien Bergamini 
123684ca7670SDamien Bergamini 	if (r & IPW_INTR_FW_INIT_DONE)
1237ceaec73dSDamien Bergamini 		wakeup(sc);
1238ceaec73dSDamien Bergamini 
1239ceaec73dSDamien Bergamini 	if (r & IPW_INTR_RX_TRANSFER)
1240ceaec73dSDamien Bergamini 		ipw_rx_intr(sc);
1241ceaec73dSDamien Bergamini 
1242ceaec73dSDamien Bergamini 	if (r & IPW_INTR_TX_TRANSFER)
1243ceaec73dSDamien Bergamini 		ipw_tx_intr(sc);
1244ceaec73dSDamien Bergamini 
1245ceaec73dSDamien Bergamini 	/* re-enable interrupts */
1246ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_INTR_MASK, IPW_INTR_MASK);
1247ceaec73dSDamien Bergamini 
124884ca7670SDamien Bergamini 	mtx_unlock(&sc->sc_mtx);
1249ceaec73dSDamien Bergamini }
1250ceaec73dSDamien Bergamini 
1251ceaec73dSDamien Bergamini static void
1252ceaec73dSDamien Bergamini ipw_dma_map_addr(void *arg, bus_dma_segment_t *segs, int nseg, int error)
1253ceaec73dSDamien Bergamini {
1254ceaec73dSDamien Bergamini 	if (error != 0)
1255ceaec73dSDamien Bergamini 		return;
1256ceaec73dSDamien Bergamini 
1257ceaec73dSDamien Bergamini 	KASSERT(nseg == 1, ("too many DMA segments, %d should be 1", nseg));
1258ceaec73dSDamien Bergamini 
1259ceaec73dSDamien Bergamini 	*(bus_addr_t *)arg = segs[0].ds_addr;
1260ceaec73dSDamien Bergamini }
1261ceaec73dSDamien Bergamini 
1262ceaec73dSDamien Bergamini /*
1263ceaec73dSDamien Bergamini  * Send a command to the firmware and wait for the acknowledgement.
1264ceaec73dSDamien Bergamini  */
1265ceaec73dSDamien Bergamini static int
1266ceaec73dSDamien Bergamini ipw_cmd(struct ipw_softc *sc, uint32_t type, void *data, uint32_t len)
1267ceaec73dSDamien Bergamini {
1268ceaec73dSDamien Bergamini 	struct ipw_soft_bd *sbd;
1269ceaec73dSDamien Bergamini 	bus_addr_t physaddr;
1270ceaec73dSDamien Bergamini 	int error;
1271ceaec73dSDamien Bergamini 
1272ceaec73dSDamien Bergamini 	sbd = &sc->stbd_list[sc->txcur];
1273ceaec73dSDamien Bergamini 
1274ceaec73dSDamien Bergamini 	error = bus_dmamap_load(sc->cmd_dmat, sc->cmd_map, &sc->cmd,
1275ceaec73dSDamien Bergamini 	    sizeof (struct ipw_cmd), ipw_dma_map_addr, &physaddr, 0);
1276ceaec73dSDamien Bergamini 	if (error != 0) {
1277ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not map command DMA memory\n");
1278ceaec73dSDamien Bergamini 		return error;
1279ceaec73dSDamien Bergamini 	}
1280ceaec73dSDamien Bergamini 
1281ceaec73dSDamien Bergamini 	sc->cmd.type = htole32(type);
1282ceaec73dSDamien Bergamini 	sc->cmd.subtype = 0;
1283ceaec73dSDamien Bergamini 	sc->cmd.len = htole32(len);
1284ceaec73dSDamien Bergamini 	sc->cmd.seq = 0;
12853afda804SDamien Bergamini 	memcpy(sc->cmd.data, data, len);
1286ceaec73dSDamien Bergamini 
1287ceaec73dSDamien Bergamini 	sbd->type = IPW_SBD_TYPE_COMMAND;
1288ceaec73dSDamien Bergamini 	sbd->bd->physaddr = htole32(physaddr);
1289ceaec73dSDamien Bergamini 	sbd->bd->len = htole32(sizeof (struct ipw_cmd));
1290ceaec73dSDamien Bergamini 	sbd->bd->nfrag = 1;
1291ceaec73dSDamien Bergamini 	sbd->bd->flags = IPW_BD_FLAG_TX_FRAME_COMMAND |
1292ceaec73dSDamien Bergamini 	    IPW_BD_FLAG_TX_LAST_FRAGMENT;
1293ceaec73dSDamien Bergamini 
1294ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->cmd_dmat, sc->cmd_map, BUS_DMASYNC_PREWRITE);
1295ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->tbd_dmat, sc->tbd_map, BUS_DMASYNC_PREWRITE);
1296ceaec73dSDamien Bergamini 
1297ceaec73dSDamien Bergamini 	DPRINTFN(2, ("sending command (%u, %u, %u, %u)\n", type, 0, 0, len));
1298ceaec73dSDamien Bergamini 
1299ceaec73dSDamien Bergamini 	/* kick firmware */
1300ceaec73dSDamien Bergamini 	sc->txfree--;
1301ceaec73dSDamien Bergamini 	sc->txcur = (sc->txcur + 1) % IPW_NTBD;
1302ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_TX_WRITE, sc->txcur);
1303ceaec73dSDamien Bergamini 
1304ceaec73dSDamien Bergamini 	/* wait at most one second for command to complete */
1305ceaec73dSDamien Bergamini 	return msleep(sc, &sc->sc_mtx, 0, "ipwcmd", hz);
1306ceaec73dSDamien Bergamini }
1307ceaec73dSDamien Bergamini 
1308ceaec73dSDamien Bergamini static int
1309ceaec73dSDamien Bergamini ipw_tx_start(struct ifnet *ifp, struct mbuf *m0, struct ieee80211_node *ni)
1310ceaec73dSDamien Bergamini {
1311ceaec73dSDamien Bergamini 	struct ipw_softc *sc = ifp->if_softc;
1312ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1313ceaec73dSDamien Bergamini 	struct ieee80211_frame *wh;
1314ceaec73dSDamien Bergamini 	struct ipw_soft_bd *sbd;
1315ceaec73dSDamien Bergamini 	struct ipw_soft_hdr *shdr;
1316ceaec73dSDamien Bergamini 	struct ipw_soft_buf *sbuf;
1317ceaec73dSDamien Bergamini 	struct ieee80211_key *k;
1318ceaec73dSDamien Bergamini 	struct mbuf *mnew;
1319ceaec73dSDamien Bergamini 	bus_dma_segment_t segs[IPW_MAX_NSEG];
1320ceaec73dSDamien Bergamini 	bus_addr_t physaddr;
1321ceaec73dSDamien Bergamini 	int nsegs, error, i;
1322ceaec73dSDamien Bergamini 
1323ceaec73dSDamien Bergamini 	wh = mtod(m0, struct ieee80211_frame *);
1324ceaec73dSDamien Bergamini 
1325ceaec73dSDamien Bergamini 	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
1326ceaec73dSDamien Bergamini 		k = ieee80211_crypto_encap(ic, ni, m0);
132782145663SSam Leffler 		if (k == NULL) {
132882145663SSam Leffler 			m_freem(m0);
1329ceaec73dSDamien Bergamini 			return ENOBUFS;
133082145663SSam Leffler 		}
1331ceaec73dSDamien Bergamini 
1332ceaec73dSDamien Bergamini 		/* packet header may have moved, reset our local pointer */
1333ceaec73dSDamien Bergamini 		wh = mtod(m0, struct ieee80211_frame *);
1334ceaec73dSDamien Bergamini 	}
1335ceaec73dSDamien Bergamini 
133616d878ccSChristian S.J. Peron 	if (bpf_peers_present(sc->sc_drvbpf)) {
1337ceaec73dSDamien Bergamini 		struct ipw_tx_radiotap_header *tap = &sc->sc_txtap;
1338ceaec73dSDamien Bergamini 
1339ceaec73dSDamien Bergamini 		tap->wt_flags = 0;
134084ca7670SDamien Bergamini 		tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq);
134184ca7670SDamien Bergamini 		tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags);
1342ceaec73dSDamien Bergamini 
1343ceaec73dSDamien Bergamini 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m0);
1344ceaec73dSDamien Bergamini 	}
1345ceaec73dSDamien Bergamini 
1346ceaec73dSDamien Bergamini 	shdr = SLIST_FIRST(&sc->free_shdr);
1347ceaec73dSDamien Bergamini 	sbuf = SLIST_FIRST(&sc->free_sbuf);
1348ceaec73dSDamien Bergamini 	KASSERT(shdr != NULL && sbuf != NULL, ("empty sw hdr/buf pool"));
1349ceaec73dSDamien Bergamini 
1350ceaec73dSDamien Bergamini 	shdr->hdr.type = htole32(IPW_HDR_TYPE_SEND);
1351ceaec73dSDamien Bergamini 	shdr->hdr.subtype = 0;
1352ceaec73dSDamien Bergamini 	shdr->hdr.encrypted = (wh->i_fc[1] & IEEE80211_FC1_WEP) ? 1 : 0;
1353ceaec73dSDamien Bergamini 	shdr->hdr.encrypt = 0;
1354ceaec73dSDamien Bergamini 	shdr->hdr.keyidx = 0;
1355ceaec73dSDamien Bergamini 	shdr->hdr.keysz = 0;
1356ceaec73dSDamien Bergamini 	shdr->hdr.fragmentsz = 0;
1357ceaec73dSDamien Bergamini 	IEEE80211_ADDR_COPY(shdr->hdr.src_addr, wh->i_addr2);
1358ceaec73dSDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_STA)
1359ceaec73dSDamien Bergamini 		IEEE80211_ADDR_COPY(shdr->hdr.dst_addr, wh->i_addr3);
1360ceaec73dSDamien Bergamini 	else
1361ceaec73dSDamien Bergamini 		IEEE80211_ADDR_COPY(shdr->hdr.dst_addr, wh->i_addr1);
1362ceaec73dSDamien Bergamini 
1363ceaec73dSDamien Bergamini 	/* trim IEEE802.11 header */
1364ceaec73dSDamien Bergamini 	m_adj(m0, sizeof (struct ieee80211_frame));
1365ceaec73dSDamien Bergamini 
1366ceaec73dSDamien Bergamini 	error = bus_dmamap_load_mbuf_sg(sc->txbuf_dmat, sbuf->map, m0, segs,
1367ceaec73dSDamien Bergamini 	    &nsegs, 0);
1368ceaec73dSDamien Bergamini 	if (error != 0 && error != EFBIG) {
1369ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not map mbuf (error %d)\n",
1370ceaec73dSDamien Bergamini 		    error);
1371ceaec73dSDamien Bergamini 		m_freem(m0);
1372ceaec73dSDamien Bergamini 		return error;
1373ceaec73dSDamien Bergamini 	}
1374ceaec73dSDamien Bergamini 	if (error != 0) {
1375ceaec73dSDamien Bergamini 		mnew = m_defrag(m0, M_DONTWAIT);
1376ceaec73dSDamien Bergamini 		if (mnew == NULL) {
1377ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
1378ceaec73dSDamien Bergamini 			    "could not defragment mbuf\n");
1379ceaec73dSDamien Bergamini 			m_freem(m0);
1380ceaec73dSDamien Bergamini 			return ENOBUFS;
1381ceaec73dSDamien Bergamini 		}
1382ceaec73dSDamien Bergamini 		m0 = mnew;
1383ceaec73dSDamien Bergamini 
1384ceaec73dSDamien Bergamini 		error = bus_dmamap_load_mbuf_sg(sc->txbuf_dmat, sbuf->map, m0,
1385ceaec73dSDamien Bergamini 		    segs, &nsegs, 0);
1386ceaec73dSDamien Bergamini 		if (error != 0) {
1387ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
1388ceaec73dSDamien Bergamini 			    "could not map mbuf (error %d)\n", error);
1389ceaec73dSDamien Bergamini 			m_freem(m0);
1390ceaec73dSDamien Bergamini 			return error;
1391ceaec73dSDamien Bergamini 		}
1392ceaec73dSDamien Bergamini 	}
1393ceaec73dSDamien Bergamini 
1394ceaec73dSDamien Bergamini 	error = bus_dmamap_load(sc->hdr_dmat, shdr->map, &shdr->hdr,
1395ceaec73dSDamien Bergamini 	    sizeof (struct ipw_hdr), ipw_dma_map_addr, &physaddr, 0);
1396ceaec73dSDamien Bergamini 	if (error != 0) {
1397ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not map header DMA memory\n");
1398ceaec73dSDamien Bergamini 		bus_dmamap_unload(sc->txbuf_dmat, sbuf->map);
1399ceaec73dSDamien Bergamini 		m_freem(m0);
1400ceaec73dSDamien Bergamini 		return error;
1401ceaec73dSDamien Bergamini 	}
1402ceaec73dSDamien Bergamini 
1403ceaec73dSDamien Bergamini 	SLIST_REMOVE_HEAD(&sc->free_sbuf, next);
1404ceaec73dSDamien Bergamini 	SLIST_REMOVE_HEAD(&sc->free_shdr, next);
1405ceaec73dSDamien Bergamini 
1406ceaec73dSDamien Bergamini 	sbd = &sc->stbd_list[sc->txcur];
1407ceaec73dSDamien Bergamini 	sbd->type = IPW_SBD_TYPE_HEADER;
1408ceaec73dSDamien Bergamini 	sbd->priv = shdr;
1409ceaec73dSDamien Bergamini 	sbd->bd->physaddr = htole32(physaddr);
1410ceaec73dSDamien Bergamini 	sbd->bd->len = htole32(sizeof (struct ipw_hdr));
1411ceaec73dSDamien Bergamini 	sbd->bd->nfrag = 1 + nsegs;
1412ceaec73dSDamien Bergamini 	sbd->bd->flags = IPW_BD_FLAG_TX_FRAME_802_3 |
1413ceaec73dSDamien Bergamini 	    IPW_BD_FLAG_TX_NOT_LAST_FRAGMENT;
1414ceaec73dSDamien Bergamini 
1415ceaec73dSDamien Bergamini 	DPRINTFN(5, ("sending tx hdr (%u, %u, %u, %u, %6D, %6D)\n",
1416ceaec73dSDamien Bergamini 	    shdr->hdr.type, shdr->hdr.subtype, shdr->hdr.encrypted,
1417ceaec73dSDamien Bergamini 	    shdr->hdr.encrypt, shdr->hdr.src_addr, ":", shdr->hdr.dst_addr,
1418ceaec73dSDamien Bergamini 	    ":"));
1419ceaec73dSDamien Bergamini 
1420ceaec73dSDamien Bergamini 	sc->txfree--;
1421ceaec73dSDamien Bergamini 	sc->txcur = (sc->txcur + 1) % IPW_NTBD;
1422ceaec73dSDamien Bergamini 
1423ceaec73dSDamien Bergamini 	sbuf->m = m0;
1424ceaec73dSDamien Bergamini 	sbuf->ni = ni;
1425ceaec73dSDamien Bergamini 
1426ceaec73dSDamien Bergamini 	for (i = 0; i < nsegs; i++) {
1427ceaec73dSDamien Bergamini 		sbd = &sc->stbd_list[sc->txcur];
1428ceaec73dSDamien Bergamini 
1429ceaec73dSDamien Bergamini 		sbd->bd->physaddr = htole32(segs[i].ds_addr);
1430ceaec73dSDamien Bergamini 		sbd->bd->len = htole32(segs[i].ds_len);
1431ceaec73dSDamien Bergamini 		sbd->bd->nfrag = 0;
1432ceaec73dSDamien Bergamini 		sbd->bd->flags = IPW_BD_FLAG_TX_FRAME_802_3;
1433ceaec73dSDamien Bergamini 		if (i == nsegs - 1) {
1434ceaec73dSDamien Bergamini 			sbd->type = IPW_SBD_TYPE_DATA;
1435ceaec73dSDamien Bergamini 			sbd->priv = sbuf;
1436ceaec73dSDamien Bergamini 			sbd->bd->flags |= IPW_BD_FLAG_TX_LAST_FRAGMENT;
1437ceaec73dSDamien Bergamini 		} else {
1438ceaec73dSDamien Bergamini 			sbd->type = IPW_SBD_TYPE_NOASSOC;
1439ceaec73dSDamien Bergamini 			sbd->bd->flags |= IPW_BD_FLAG_TX_NOT_LAST_FRAGMENT;
1440ceaec73dSDamien Bergamini 		}
1441ceaec73dSDamien Bergamini 
1442ceaec73dSDamien Bergamini 		DPRINTFN(5, ("sending fragment (%d, %d)\n", i, segs[i].ds_len));
1443ceaec73dSDamien Bergamini 
1444ceaec73dSDamien Bergamini 		sc->txfree--;
1445ceaec73dSDamien Bergamini 		sc->txcur = (sc->txcur + 1) % IPW_NTBD;
1446ceaec73dSDamien Bergamini 	}
1447ceaec73dSDamien Bergamini 
1448ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->hdr_dmat, shdr->map, BUS_DMASYNC_PREWRITE);
1449ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->txbuf_dmat, sbuf->map, BUS_DMASYNC_PREWRITE);
1450ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->tbd_dmat, sc->tbd_map, BUS_DMASYNC_PREWRITE);
1451ceaec73dSDamien Bergamini 
1452ceaec73dSDamien Bergamini 	/* kick firmware */
1453ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_TX_WRITE, sc->txcur);
1454ceaec73dSDamien Bergamini 
1455ceaec73dSDamien Bergamini 	return 0;
1456ceaec73dSDamien Bergamini }
1457ceaec73dSDamien Bergamini 
1458ceaec73dSDamien Bergamini static void
1459ceaec73dSDamien Bergamini ipw_start(struct ifnet *ifp)
1460ceaec73dSDamien Bergamini {
1461ceaec73dSDamien Bergamini 	struct ipw_softc *sc = ifp->if_softc;
1462ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1463ceaec73dSDamien Bergamini 	struct mbuf *m0;
1464ceaec73dSDamien Bergamini 	struct ether_header *eh;
1465ceaec73dSDamien Bergamini 	struct ieee80211_node *ni;
1466ceaec73dSDamien Bergamini 
146784ca7670SDamien Bergamini 	mtx_lock(&sc->sc_mtx);
1468ceaec73dSDamien Bergamini 
1469ceaec73dSDamien Bergamini 	if (ic->ic_state != IEEE80211_S_RUN) {
147084ca7670SDamien Bergamini 		mtx_unlock(&sc->sc_mtx);
1471ceaec73dSDamien Bergamini 		return;
1472ceaec73dSDamien Bergamini 	}
1473ceaec73dSDamien Bergamini 
1474ceaec73dSDamien Bergamini 	for (;;) {
1475ceaec73dSDamien Bergamini 		IFQ_DRV_DEQUEUE(&ifp->if_snd, m0);
1476ceaec73dSDamien Bergamini 		if (m0 == NULL)
1477ceaec73dSDamien Bergamini 			break;
1478ceaec73dSDamien Bergamini 
1479ceaec73dSDamien Bergamini 		if (sc->txfree < 1 + IPW_MAX_NSEG) {
1480ceaec73dSDamien Bergamini 			IFQ_DRV_PREPEND(&ifp->if_snd, m0);
148113f4c340SRobert Watson 			ifp->if_drv_flags |= IFF_DRV_OACTIVE;
1482ceaec73dSDamien Bergamini 			break;
1483ceaec73dSDamien Bergamini 		}
1484ceaec73dSDamien Bergamini 
1485ceaec73dSDamien Bergamini 		if (m0->m_len < sizeof (struct ether_header) &&
1486ceaec73dSDamien Bergamini 		    (m0 = m_pullup(m0, sizeof (struct ether_header))) == NULL)
1487ceaec73dSDamien Bergamini 			continue;
1488ceaec73dSDamien Bergamini 
1489ceaec73dSDamien Bergamini 		eh = mtod(m0, struct ether_header *);
1490ceaec73dSDamien Bergamini 		ni = ieee80211_find_txnode(ic, eh->ether_dhost);
1491ceaec73dSDamien Bergamini 		if (ni == NULL) {
1492ceaec73dSDamien Bergamini 			m_freem(m0);
1493ceaec73dSDamien Bergamini 			continue;
1494ceaec73dSDamien Bergamini 		}
1495ceaec73dSDamien Bergamini 		BPF_MTAP(ifp, m0);
1496ceaec73dSDamien Bergamini 
1497ceaec73dSDamien Bergamini 		m0 = ieee80211_encap(ic, m0, ni);
1498ceaec73dSDamien Bergamini 		if (m0 == NULL) {
1499ceaec73dSDamien Bergamini 			ieee80211_free_node(ni);
1500ceaec73dSDamien Bergamini 			continue;
1501ceaec73dSDamien Bergamini 		}
1502ceaec73dSDamien Bergamini 
1503ff046a6cSSam Leffler 		if (bpf_peers_present(ic->ic_rawbpf))
1504ceaec73dSDamien Bergamini 			bpf_mtap(ic->ic_rawbpf, m0);
1505ceaec73dSDamien Bergamini 
1506ceaec73dSDamien Bergamini 		if (ipw_tx_start(ifp, m0, ni) != 0) {
1507ceaec73dSDamien Bergamini 			ieee80211_free_node(ni);
1508ceaec73dSDamien Bergamini 			ifp->if_oerrors++;
1509ceaec73dSDamien Bergamini 			break;
1510ceaec73dSDamien Bergamini 		}
1511ceaec73dSDamien Bergamini 
1512ceaec73dSDamien Bergamini 		/* start watchdog timer */
1513ceaec73dSDamien Bergamini 		sc->sc_tx_timer = 5;
1514ceaec73dSDamien Bergamini 		ifp->if_timer = 1;
1515ceaec73dSDamien Bergamini 	}
1516ceaec73dSDamien Bergamini 
151784ca7670SDamien Bergamini 	mtx_unlock(&sc->sc_mtx);
1518ceaec73dSDamien Bergamini }
1519ceaec73dSDamien Bergamini 
1520ceaec73dSDamien Bergamini static void
1521ceaec73dSDamien Bergamini ipw_watchdog(struct ifnet *ifp)
1522ceaec73dSDamien Bergamini {
1523ceaec73dSDamien Bergamini 	struct ipw_softc *sc = ifp->if_softc;
1524ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1525ceaec73dSDamien Bergamini 
152684ca7670SDamien Bergamini 	mtx_lock(&sc->sc_mtx);
152784ca7670SDamien Bergamini 
1528ceaec73dSDamien Bergamini 	ifp->if_timer = 0;
1529ceaec73dSDamien Bergamini 
1530ceaec73dSDamien Bergamini 	if (sc->sc_tx_timer > 0) {
1531ceaec73dSDamien Bergamini 		if (--sc->sc_tx_timer == 0) {
1532ceaec73dSDamien Bergamini 			if_printf(ifp, "device timeout\n");
1533ceaec73dSDamien Bergamini 			ifp->if_oerrors++;
153484ca7670SDamien Bergamini 			taskqueue_enqueue_fast(taskqueue_fast,
153584ca7670SDamien Bergamini 			    &sc->sc_init_task);
153684ca7670SDamien Bergamini 			mtx_unlock(&sc->sc_mtx);
1537ceaec73dSDamien Bergamini 			return;
1538ceaec73dSDamien Bergamini 		}
1539ceaec73dSDamien Bergamini 		ifp->if_timer = 1;
1540ceaec73dSDamien Bergamini 	}
1541ceaec73dSDamien Bergamini 
1542ceaec73dSDamien Bergamini 	ieee80211_watchdog(ic);
154384ca7670SDamien Bergamini 
154484ca7670SDamien Bergamini 	mtx_unlock(&sc->sc_mtx);
1545ceaec73dSDamien Bergamini }
1546ceaec73dSDamien Bergamini 
1547ceaec73dSDamien Bergamini static int
1548ceaec73dSDamien Bergamini ipw_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
1549ceaec73dSDamien Bergamini {
1550ceaec73dSDamien Bergamini 	struct ipw_softc *sc = ifp->if_softc;
1551ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1552ceaec73dSDamien Bergamini 	int error = 0;
1553ceaec73dSDamien Bergamini 
155484ca7670SDamien Bergamini 	mtx_lock(&sc->sc_mtx);
1555ceaec73dSDamien Bergamini 
1556ceaec73dSDamien Bergamini 	switch (cmd) {
1557ceaec73dSDamien Bergamini 	case SIOCSIFFLAGS:
1558ceaec73dSDamien Bergamini 		if (ifp->if_flags & IFF_UP) {
155913f4c340SRobert Watson 			if (!(ifp->if_drv_flags & IFF_DRV_RUNNING))
1560ceaec73dSDamien Bergamini 				ipw_init(sc);
1561ceaec73dSDamien Bergamini 		} else {
156213f4c340SRobert Watson 			if (ifp->if_drv_flags & IFF_DRV_RUNNING)
1563ceaec73dSDamien Bergamini 				ipw_stop(sc);
1564ceaec73dSDamien Bergamini 		}
1565ceaec73dSDamien Bergamini 		break;
1566ceaec73dSDamien Bergamini 
1567ceaec73dSDamien Bergamini 	default:
1568ceaec73dSDamien Bergamini 		error = ieee80211_ioctl(ic, cmd, data);
1569ceaec73dSDamien Bergamini 	}
1570ceaec73dSDamien Bergamini 
1571ceaec73dSDamien Bergamini 	if (error == ENETRESET) {
157213f4c340SRobert Watson 		if ((ifp->if_flags & IFF_UP) &&
157313f4c340SRobert Watson 		    (ifp->if_drv_flags & IFF_DRV_RUNNING))
1574ceaec73dSDamien Bergamini 			ipw_init(sc);
1575ceaec73dSDamien Bergamini 		error = 0;
1576ceaec73dSDamien Bergamini 	}
1577ceaec73dSDamien Bergamini 
157884ca7670SDamien Bergamini 	mtx_unlock(&sc->sc_mtx);
1579ceaec73dSDamien Bergamini 
1580ceaec73dSDamien Bergamini 	return error;
1581ceaec73dSDamien Bergamini }
1582ceaec73dSDamien Bergamini 
1583ceaec73dSDamien Bergamini static void
1584ceaec73dSDamien Bergamini ipw_stop_master(struct ipw_softc *sc)
1585ceaec73dSDamien Bergamini {
158684ca7670SDamien Bergamini 	uint32_t tmp;
1587ceaec73dSDamien Bergamini 	int ntries;
1588ceaec73dSDamien Bergamini 
1589ceaec73dSDamien Bergamini 	/* disable interrupts */
1590ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_INTR_MASK, 0);
1591ceaec73dSDamien Bergamini 
1592ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_RST, IPW_RST_STOP_MASTER);
1593ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 50; ntries++) {
1594ceaec73dSDamien Bergamini 		if (CSR_READ_4(sc, IPW_CSR_RST) & IPW_RST_MASTER_DISABLED)
1595ceaec73dSDamien Bergamini 			break;
1596ceaec73dSDamien Bergamini 		DELAY(10);
1597ceaec73dSDamien Bergamini 	}
1598ceaec73dSDamien Bergamini 	if (ntries == 50)
1599ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "timeout waiting for master\n");
1600ceaec73dSDamien Bergamini 
160184ca7670SDamien Bergamini 	tmp = CSR_READ_4(sc, IPW_CSR_RST);
160284ca7670SDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_RST, tmp | IPW_RST_PRINCETON_RESET);
1603ceaec73dSDamien Bergamini 
1604ceaec73dSDamien Bergamini 	sc->flags &= ~IPW_FLAG_FW_INITED;
1605ceaec73dSDamien Bergamini }
1606ceaec73dSDamien Bergamini 
1607ceaec73dSDamien Bergamini static int
1608ceaec73dSDamien Bergamini ipw_reset(struct ipw_softc *sc)
1609ceaec73dSDamien Bergamini {
161084ca7670SDamien Bergamini 	uint32_t tmp;
1611ceaec73dSDamien Bergamini 	int ntries;
1612ceaec73dSDamien Bergamini 
1613ceaec73dSDamien Bergamini 	ipw_stop_master(sc);
1614ceaec73dSDamien Bergamini 
1615ceaec73dSDamien Bergamini 	/* move adapter to D0 state */
161684ca7670SDamien Bergamini 	tmp = CSR_READ_4(sc, IPW_CSR_CTL);
161784ca7670SDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_CTL, tmp | IPW_CTL_INIT);
1618ceaec73dSDamien Bergamini 
1619ceaec73dSDamien Bergamini 	/* wait for clock stabilization */
1620ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 1000; ntries++) {
1621ceaec73dSDamien Bergamini 		if (CSR_READ_4(sc, IPW_CSR_CTL) & IPW_CTL_CLOCK_READY)
1622ceaec73dSDamien Bergamini 			break;
1623ceaec73dSDamien Bergamini 		DELAY(200);
1624ceaec73dSDamien Bergamini 	}
1625ceaec73dSDamien Bergamini 	if (ntries == 1000)
1626ceaec73dSDamien Bergamini 		return EIO;
1627ceaec73dSDamien Bergamini 
162884ca7670SDamien Bergamini 	tmp =  CSR_READ_4(sc, IPW_CSR_RST);
162984ca7670SDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_RST, tmp | IPW_RST_SW_RESET);
1630ceaec73dSDamien Bergamini 
1631ceaec73dSDamien Bergamini 	DELAY(10);
1632ceaec73dSDamien Bergamini 
163384ca7670SDamien Bergamini 	tmp = CSR_READ_4(sc, IPW_CSR_CTL);
163484ca7670SDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_CTL, tmp | IPW_CTL_INIT);
1635ceaec73dSDamien Bergamini 
1636ceaec73dSDamien Bergamini 	return 0;
1637ceaec73dSDamien Bergamini }
1638ceaec73dSDamien Bergamini 
1639ceaec73dSDamien Bergamini /*
1640ceaec73dSDamien Bergamini  * Upload the microcode to the device.
1641ceaec73dSDamien Bergamini  */
1642ceaec73dSDamien Bergamini static int
164384ca7670SDamien Bergamini ipw_load_ucode(struct ipw_softc *sc, const char *uc, int size)
1644ceaec73dSDamien Bergamini {
1645ceaec73dSDamien Bergamini 	int ntries;
1646ceaec73dSDamien Bergamini 
1647ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x3000e0, 0x80000000);
1648ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_RST, 0);
1649ceaec73dSDamien Bergamini 
1650ceaec73dSDamien Bergamini 	MEM_WRITE_2(sc, 0x220000, 0x0703);
1651ceaec73dSDamien Bergamini 	MEM_WRITE_2(sc, 0x220000, 0x0707);
1652ceaec73dSDamien Bergamini 
1653ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x210014, 0x72);
1654ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x210014, 0x72);
1655ceaec73dSDamien Bergamini 
1656ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x210000, 0x40);
1657ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x210000, 0x00);
1658ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x210000, 0x40);
1659ceaec73dSDamien Bergamini 
1660ceaec73dSDamien Bergamini 	MEM_WRITE_MULTI_1(sc, 0x210010, uc, size);
1661ceaec73dSDamien Bergamini 
1662ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x210000, 0x00);
1663ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x210000, 0x00);
1664ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x210000, 0x80);
1665ceaec73dSDamien Bergamini 
1666ceaec73dSDamien Bergamini 	MEM_WRITE_2(sc, 0x220000, 0x0703);
1667ceaec73dSDamien Bergamini 	MEM_WRITE_2(sc, 0x220000, 0x0707);
1668ceaec73dSDamien Bergamini 
1669ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x210014, 0x72);
1670ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x210014, 0x72);
1671ceaec73dSDamien Bergamini 
1672ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x210000, 0x00);
1673ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x210000, 0x80);
1674ceaec73dSDamien Bergamini 
1675ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 10; ntries++) {
1676ceaec73dSDamien Bergamini 		if (MEM_READ_1(sc, 0x210000) & 1)
1677ceaec73dSDamien Bergamini 			break;
1678ceaec73dSDamien Bergamini 		DELAY(10);
1679ceaec73dSDamien Bergamini 	}
1680ceaec73dSDamien Bergamini 	if (ntries == 10) {
1681ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
1682ceaec73dSDamien Bergamini 		    "timeout waiting for ucode to initialize\n");
1683ceaec73dSDamien Bergamini 		return EIO;
1684ceaec73dSDamien Bergamini 	}
1685ceaec73dSDamien Bergamini 
1686ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x3000e0, 0);
1687ceaec73dSDamien Bergamini 
1688ceaec73dSDamien Bergamini 	return 0;
1689ceaec73dSDamien Bergamini }
1690ceaec73dSDamien Bergamini 
1691ceaec73dSDamien Bergamini /* set of macros to handle unaligned little endian data in firmware image */
1692ceaec73dSDamien Bergamini #define GETLE32(p) ((p)[0] | (p)[1] << 8 | (p)[2] << 16 | (p)[3] << 24)
1693ceaec73dSDamien Bergamini #define GETLE16(p) ((p)[0] | (p)[1] << 8)
1694ceaec73dSDamien Bergamini static int
169584ca7670SDamien Bergamini ipw_load_firmware(struct ipw_softc *sc, const char *fw, int size)
1696ceaec73dSDamien Bergamini {
169784ca7670SDamien Bergamini 	const uint8_t *p, *end;
169884ca7670SDamien Bergamini 	uint32_t tmp, dst;
1699ceaec73dSDamien Bergamini 	uint16_t len;
1700ceaec73dSDamien Bergamini 	int error;
1701ceaec73dSDamien Bergamini 
1702ceaec73dSDamien Bergamini 	p = fw;
1703ceaec73dSDamien Bergamini 	end = fw + size;
1704ceaec73dSDamien Bergamini 	while (p < end) {
1705ceaec73dSDamien Bergamini 		dst = GETLE32(p); p += 4;
1706ceaec73dSDamien Bergamini 		len = GETLE16(p); p += 2;
1707ceaec73dSDamien Bergamini 
1708ceaec73dSDamien Bergamini 		ipw_write_mem_1(sc, dst, p, len);
1709ceaec73dSDamien Bergamini 		p += len;
1710ceaec73dSDamien Bergamini 	}
1711ceaec73dSDamien Bergamini 
1712ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_IO, IPW_IO_GPIO1_ENABLE | IPW_IO_GPIO3_MASK |
1713ceaec73dSDamien Bergamini 	    IPW_IO_LED_OFF);
1714ceaec73dSDamien Bergamini 
1715ceaec73dSDamien Bergamini 	/* enable interrupts */
1716ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_INTR_MASK, IPW_INTR_MASK);
1717ceaec73dSDamien Bergamini 
1718ceaec73dSDamien Bergamini 	/* kick the firmware */
1719ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_RST, 0);
1720ceaec73dSDamien Bergamini 
172184ca7670SDamien Bergamini 	tmp = CSR_READ_4(sc, IPW_CSR_CTL);
172284ca7670SDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_CTL, tmp | IPW_CTL_ALLOW_STANDBY);
1723ceaec73dSDamien Bergamini 
1724ceaec73dSDamien Bergamini 	/* wait at most one second for firmware initialization to complete */
1725ceaec73dSDamien Bergamini 	if ((error = msleep(sc, &sc->sc_mtx, 0, "ipwinit", hz)) != 0) {
1726ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "timeout waiting for firmware "
1727ceaec73dSDamien Bergamini 		    "initialization to complete\n");
1728ceaec73dSDamien Bergamini 		return error;
1729ceaec73dSDamien Bergamini 	}
1730ceaec73dSDamien Bergamini 
173184ca7670SDamien Bergamini 	tmp = CSR_READ_4(sc, IPW_CSR_IO);
173284ca7670SDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_IO, tmp | IPW_IO_GPIO1_MASK |
173384ca7670SDamien Bergamini 	    IPW_IO_GPIO3_MASK);
1734ceaec73dSDamien Bergamini 
1735ceaec73dSDamien Bergamini 	return 0;
1736ceaec73dSDamien Bergamini }
1737ceaec73dSDamien Bergamini 
1738ceaec73dSDamien Bergamini static int
1739ceaec73dSDamien Bergamini ipw_config(struct ipw_softc *sc)
1740ceaec73dSDamien Bergamini {
1741ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1742ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
1743ceaec73dSDamien Bergamini 	struct ipw_security security;
1744ceaec73dSDamien Bergamini 	struct ieee80211_key *k;
1745ceaec73dSDamien Bergamini 	struct ipw_wep_key wepkey;
1746ceaec73dSDamien Bergamini 	struct ipw_scan_options options;
1747ceaec73dSDamien Bergamini 	struct ipw_configuration config;
1748ceaec73dSDamien Bergamini 	uint32_t data;
1749ceaec73dSDamien Bergamini 	int error, i;
1750ceaec73dSDamien Bergamini 
1751ceaec73dSDamien Bergamini 	switch (ic->ic_opmode) {
1752ceaec73dSDamien Bergamini 	case IEEE80211_M_STA:
1753ceaec73dSDamien Bergamini 	case IEEE80211_M_HOSTAP:
1754ceaec73dSDamien Bergamini 		data = htole32(IPW_MODE_BSS);
1755ceaec73dSDamien Bergamini 		break;
1756ceaec73dSDamien Bergamini 	case IEEE80211_M_IBSS:
1757ceaec73dSDamien Bergamini 	case IEEE80211_M_AHDEMO:
1758ceaec73dSDamien Bergamini 		data = htole32(IPW_MODE_IBSS);
1759ceaec73dSDamien Bergamini 		break;
1760ceaec73dSDamien Bergamini 	case IEEE80211_M_MONITOR:
1761ceaec73dSDamien Bergamini 		data = htole32(IPW_MODE_MONITOR);
1762ceaec73dSDamien Bergamini 		break;
1763ceaec73dSDamien Bergamini 	}
1764ceaec73dSDamien Bergamini 	DPRINTF(("Setting mode to %u\n", le32toh(data)));
1765ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_MODE, &data, sizeof data);
1766ceaec73dSDamien Bergamini 	if (error != 0)
1767ceaec73dSDamien Bergamini 		return error;
1768ceaec73dSDamien Bergamini 
1769ceaec73dSDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_IBSS ||
1770ceaec73dSDamien Bergamini 	    ic->ic_opmode == IEEE80211_M_MONITOR) {
177184ca7670SDamien Bergamini 		data = htole32(ieee80211_chan2ieee(ic, ic->ic_curchan));
1772ceaec73dSDamien Bergamini 		DPRINTF(("Setting channel to %u\n", le32toh(data)));
1773ceaec73dSDamien Bergamini 		error = ipw_cmd(sc, IPW_CMD_SET_CHANNEL, &data, sizeof data);
1774ceaec73dSDamien Bergamini 		if (error != 0)
1775ceaec73dSDamien Bergamini 			return error;
1776ceaec73dSDamien Bergamini 	}
1777ceaec73dSDamien Bergamini 
1778ceaec73dSDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_MONITOR) {
1779ceaec73dSDamien Bergamini 		DPRINTF(("Enabling adapter\n"));
1780ceaec73dSDamien Bergamini 		return ipw_cmd(sc, IPW_CMD_ENABLE, NULL, 0);
1781ceaec73dSDamien Bergamini 	}
1782ceaec73dSDamien Bergamini 
1783ceaec73dSDamien Bergamini 	IEEE80211_ADDR_COPY(ic->ic_myaddr, IF_LLADDR(ifp));
1784ceaec73dSDamien Bergamini 	DPRINTF(("Setting MAC address to %6D\n", ic->ic_myaddr, ":"));
1785ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_MAC_ADDRESS, ic->ic_myaddr,
1786ceaec73dSDamien Bergamini 	    IEEE80211_ADDR_LEN);
1787ceaec73dSDamien Bergamini 	if (error != 0)
1788ceaec73dSDamien Bergamini 		return error;
1789ceaec73dSDamien Bergamini 
1790ceaec73dSDamien Bergamini 	config.flags = htole32(IPW_CFG_BSS_MASK | IPW_CFG_IBSS_MASK |
1791ceaec73dSDamien Bergamini 	    IPW_CFG_PREAMBLE_AUTO | IPW_CFG_802_1x_ENABLE);
1792ceaec73dSDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_IBSS)
1793ceaec73dSDamien Bergamini 		config.flags |= htole32(IPW_CFG_IBSS_AUTO_START);
1794ceaec73dSDamien Bergamini 	if (ifp->if_flags & IFF_PROMISC)
1795ceaec73dSDamien Bergamini 		config.flags |= htole32(IPW_CFG_PROMISCUOUS);
1796ceaec73dSDamien Bergamini 	config.bss_chan = htole32(0x3fff); /* channels 1-14 */
1797ceaec73dSDamien Bergamini 	config.ibss_chan = htole32(0x7ff); /* channels 1-11 */
1798ceaec73dSDamien Bergamini 	DPRINTF(("Setting configuration to 0x%x\n", le32toh(config.flags)));
1799ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_CONFIGURATION, &config, sizeof config);
1800ceaec73dSDamien Bergamini 	if (error != 0)
1801ceaec73dSDamien Bergamini 		return error;
1802ceaec73dSDamien Bergamini 
1803ceaec73dSDamien Bergamini 	data = htole32(0x3); /* 1, 2 */
1804ceaec73dSDamien Bergamini 	DPRINTF(("Setting basic tx rates to 0x%x\n", le32toh(data)));
1805ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_BASIC_TX_RATES, &data, sizeof data);
1806ceaec73dSDamien Bergamini 	if (error != 0)
1807ceaec73dSDamien Bergamini 		return error;
1808ceaec73dSDamien Bergamini 
1809ceaec73dSDamien Bergamini 	data = htole32(0xf); /* 1, 2, 5.5, 11 */
1810ceaec73dSDamien Bergamini 	DPRINTF(("Setting tx rates to 0x%x\n", le32toh(data)));
1811ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_TX_RATES, &data, sizeof data);
1812ceaec73dSDamien Bergamini 	if (error != 0)
1813ceaec73dSDamien Bergamini 		return error;
1814ceaec73dSDamien Bergamini 
1815ceaec73dSDamien Bergamini 	data = htole32(IPW_POWER_MODE_CAM);
1816ceaec73dSDamien Bergamini 	DPRINTF(("Setting power mode to %u\n", le32toh(data)));
1817ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_POWER_MODE, &data, sizeof data);
1818ceaec73dSDamien Bergamini 	if (error != 0)
1819ceaec73dSDamien Bergamini 		return error;
1820ceaec73dSDamien Bergamini 
1821ceaec73dSDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_IBSS) {
1822ceaec73dSDamien Bergamini 		data = htole32(32); /* default value */
1823ceaec73dSDamien Bergamini 		DPRINTF(("Setting tx power index to %u\n", le32toh(data)));
1824ceaec73dSDamien Bergamini 		error = ipw_cmd(sc, IPW_CMD_SET_TX_POWER_INDEX, &data,
1825ceaec73dSDamien Bergamini 		    sizeof data);
1826ceaec73dSDamien Bergamini 		if (error != 0)
1827ceaec73dSDamien Bergamini 			return error;
1828ceaec73dSDamien Bergamini 	}
1829ceaec73dSDamien Bergamini 
1830ceaec73dSDamien Bergamini 	data = htole32(ic->ic_rtsthreshold);
1831ceaec73dSDamien Bergamini 	DPRINTF(("Setting RTS threshold to %u\n", le32toh(data)));
1832ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_RTS_THRESHOLD, &data, sizeof data);
1833ceaec73dSDamien Bergamini 	if (error != 0)
1834ceaec73dSDamien Bergamini 		return error;
1835ceaec73dSDamien Bergamini 
1836ceaec73dSDamien Bergamini 	data = htole32(ic->ic_fragthreshold);
1837ceaec73dSDamien Bergamini 	DPRINTF(("Setting frag threshold to %u\n", le32toh(data)));
1838ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_FRAG_THRESHOLD, &data, sizeof data);
1839ceaec73dSDamien Bergamini 	if (error != 0)
1840ceaec73dSDamien Bergamini 		return error;
1841ceaec73dSDamien Bergamini 
1842ceaec73dSDamien Bergamini #ifdef IPW_DEBUG
1843ceaec73dSDamien Bergamini 	if (ipw_debug > 0) {
1844ceaec73dSDamien Bergamini 		printf("Setting ESSID to ");
1845ceaec73dSDamien Bergamini 		ieee80211_print_essid(ic->ic_des_essid, ic->ic_des_esslen);
1846ceaec73dSDamien Bergamini 		printf("\n");
1847ceaec73dSDamien Bergamini 	}
1848ceaec73dSDamien Bergamini #endif
1849ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_ESSID, ic->ic_des_essid,
1850ceaec73dSDamien Bergamini 	    ic->ic_des_esslen);
1851ceaec73dSDamien Bergamini 	if (error != 0)
1852ceaec73dSDamien Bergamini 		return error;
1853ceaec73dSDamien Bergamini 
1854ceaec73dSDamien Bergamini 	/* no mandatory BSSID */
1855ceaec73dSDamien Bergamini 	DPRINTF(("Setting mandatory BSSID to null\n"));
1856ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_MANDATORY_BSSID, NULL, 0);
1857ceaec73dSDamien Bergamini 	if (error != 0)
1858ceaec73dSDamien Bergamini 		return error;
1859ceaec73dSDamien Bergamini 
1860ceaec73dSDamien Bergamini 	if (ic->ic_flags & IEEE80211_F_DESBSSID) {
1861ceaec73dSDamien Bergamini 		DPRINTF(("Setting desired BSSID to %6D\n", ic->ic_des_bssid,
1862ceaec73dSDamien Bergamini 		    ":"));
1863ceaec73dSDamien Bergamini 		error = ipw_cmd(sc, IPW_CMD_SET_DESIRED_BSSID,
1864ceaec73dSDamien Bergamini 		    ic->ic_des_bssid, IEEE80211_ADDR_LEN);
1865ceaec73dSDamien Bergamini 		if (error != 0)
1866ceaec73dSDamien Bergamini 			return error;
1867ceaec73dSDamien Bergamini 	}
1868ceaec73dSDamien Bergamini 
18693afda804SDamien Bergamini 	memset(&security, 0, sizeof security);
1870ceaec73dSDamien Bergamini 	security.authmode = (ic->ic_bss->ni_authmode == IEEE80211_AUTH_SHARED) ?
1871ceaec73dSDamien Bergamini 	    IPW_AUTH_SHARED : IPW_AUTH_OPEN;
1872ceaec73dSDamien Bergamini 	security.ciphers = htole32(IPW_CIPHER_NONE);
1873ceaec73dSDamien Bergamini 	DPRINTF(("Setting authmode to %u\n", security.authmode));
1874ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_SECURITY_INFORMATION, &security,
1875ceaec73dSDamien Bergamini 	    sizeof security);
1876ceaec73dSDamien Bergamini 	if (error != 0)
1877ceaec73dSDamien Bergamini 		return error;
1878ceaec73dSDamien Bergamini 
1879ceaec73dSDamien Bergamini 	if (ic->ic_flags & IEEE80211_F_PRIVACY) {
1880ceaec73dSDamien Bergamini 		k = ic->ic_crypto.cs_nw_keys;
1881ceaec73dSDamien Bergamini 		for (i = 0; i < IEEE80211_WEP_NKID; i++, k++) {
1882ceaec73dSDamien Bergamini 			if (k->wk_keylen == 0)
1883ceaec73dSDamien Bergamini 				continue;
1884ceaec73dSDamien Bergamini 
1885ceaec73dSDamien Bergamini 			wepkey.idx = i;
1886ceaec73dSDamien Bergamini 			wepkey.len = k->wk_keylen;
18873afda804SDamien Bergamini 			memset(wepkey.key, 0, sizeof wepkey.key);
18883afda804SDamien Bergamini 			memcpy(wepkey.key, k->wk_key, k->wk_keylen);
1889ceaec73dSDamien Bergamini 			DPRINTF(("Setting wep key index %u len %u\n",
1890ceaec73dSDamien Bergamini 			    wepkey.idx, wepkey.len));
1891ceaec73dSDamien Bergamini 			error = ipw_cmd(sc, IPW_CMD_SET_WEP_KEY, &wepkey,
1892ceaec73dSDamien Bergamini 			    sizeof wepkey);
1893ceaec73dSDamien Bergamini 			if (error != 0)
1894ceaec73dSDamien Bergamini 				return error;
1895ceaec73dSDamien Bergamini 		}
1896ceaec73dSDamien Bergamini 
1897ceaec73dSDamien Bergamini 		data = htole32(ic->ic_crypto.cs_def_txkey);
1898ceaec73dSDamien Bergamini 		DPRINTF(("Setting wep tx key index to %u\n", le32toh(data)));
1899ceaec73dSDamien Bergamini 		error = ipw_cmd(sc, IPW_CMD_SET_WEP_KEY_INDEX, &data,
1900ceaec73dSDamien Bergamini 		    sizeof data);
1901ceaec73dSDamien Bergamini 		if (error != 0)
1902ceaec73dSDamien Bergamini 			return error;
1903ceaec73dSDamien Bergamini 	}
1904ceaec73dSDamien Bergamini 
1905ceaec73dSDamien Bergamini 	data = htole32((ic->ic_flags & IEEE80211_F_PRIVACY) ? IPW_WEPON : 0);
1906ceaec73dSDamien Bergamini 	DPRINTF(("Setting wep flags to 0x%x\n", le32toh(data)));
1907ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_WEP_FLAGS, &data, sizeof data);
1908ceaec73dSDamien Bergamini 	if (error != 0)
1909ceaec73dSDamien Bergamini 		return error;
1910ceaec73dSDamien Bergamini 
1911ceaec73dSDamien Bergamini #if 0
1912ceaec73dSDamien Bergamini 	struct ipw_wpa_ie ie;
1913ceaec73dSDamien Bergamini 
19143afda804SDamien Bergamini 	memset(&ie, 0, sizeof ie);
1915ceaec73dSDamien Bergamini 	ie.len = htole32(sizeof (struct ieee80211_ie_wpa));
1916ceaec73dSDamien Bergamini 	DPRINTF(("Setting wpa ie\n"));
1917ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_WPA_IE, &ie, sizeof ie);
1918ceaec73dSDamien Bergamini 	if (error != 0)
1919ceaec73dSDamien Bergamini 		return error;
1920ceaec73dSDamien Bergamini #endif
1921ceaec73dSDamien Bergamini 
1922ceaec73dSDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_IBSS) {
1923d365f9c7SSam Leffler 		data = htole32(ic->ic_bintval);
1924ceaec73dSDamien Bergamini 		DPRINTF(("Setting beacon interval to %u\n", le32toh(data)));
1925ceaec73dSDamien Bergamini 		error = ipw_cmd(sc, IPW_CMD_SET_BEACON_INTERVAL, &data,
1926ceaec73dSDamien Bergamini 		    sizeof data);
1927ceaec73dSDamien Bergamini 		if (error != 0)
1928ceaec73dSDamien Bergamini 			return error;
1929ceaec73dSDamien Bergamini 	}
1930ceaec73dSDamien Bergamini 
1931ceaec73dSDamien Bergamini 	options.flags = 0;
1932ceaec73dSDamien Bergamini 	options.channels = htole32(0x3fff); /* scan channels 1-14 */
1933ceaec73dSDamien Bergamini 	DPRINTF(("Setting scan options to 0x%x\n", le32toh(options.flags)));
1934ceaec73dSDamien Bergamini 	error = ipw_cmd(sc, IPW_CMD_SET_SCAN_OPTIONS, &options, sizeof options);
1935ceaec73dSDamien Bergamini 	if (error != 0)
1936ceaec73dSDamien Bergamini 		return error;
1937ceaec73dSDamien Bergamini 
1938ceaec73dSDamien Bergamini 	/* finally, enable adapter (start scanning for an access point) */
1939ceaec73dSDamien Bergamini 	DPRINTF(("Enabling adapter\n"));
1940ceaec73dSDamien Bergamini 	return ipw_cmd(sc, IPW_CMD_ENABLE, NULL, 0);
1941ceaec73dSDamien Bergamini }
1942ceaec73dSDamien Bergamini 
194384ca7670SDamien Bergamini /*
194484ca7670SDamien Bergamini  * Handler for sc_init_task.  This is a simple wrapper around ipw_init().
194584ca7670SDamien Bergamini  * It is called on firmware panics or on watchdog timeouts.
194684ca7670SDamien Bergamini  */
194784ca7670SDamien Bergamini static void
194884ca7670SDamien Bergamini ipw_init_task(void *context, int pending)
194984ca7670SDamien Bergamini {
195084ca7670SDamien Bergamini 	ipw_init(context);
195184ca7670SDamien Bergamini }
195284ca7670SDamien Bergamini 
1953ceaec73dSDamien Bergamini static void
1954ceaec73dSDamien Bergamini ipw_init(void *priv)
1955ceaec73dSDamien Bergamini {
1956ceaec73dSDamien Bergamini 	struct ipw_softc *sc = priv;
1957ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1958ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
195984ca7670SDamien Bergamini 	struct firmware *fp;
196084ca7670SDamien Bergamini 	const struct ipw_firmware_hdr *hdr;
196184ca7670SDamien Bergamini 	const char *imagename, *fw;
196284ca7670SDamien Bergamini 	int owned;
1963ceaec73dSDamien Bergamini 
196484ca7670SDamien Bergamini 	/*
196584ca7670SDamien Bergamini 	 * ipw_init() is exposed through ifp->if_init so it might be called
196684ca7670SDamien Bergamini 	 * without the driver's lock held.  Since msleep() doesn't like being
196784ca7670SDamien Bergamini 	 * called on a recursed mutex, we acquire the driver's lock only if
196884ca7670SDamien Bergamini 	 * we're not already holding it.
196984ca7670SDamien Bergamini 	 */
197084ca7670SDamien Bergamini 	if (!(owned = mtx_owned(&sc->sc_mtx)))
197184ca7670SDamien Bergamini 		mtx_lock(&sc->sc_mtx);
197284ca7670SDamien Bergamini 
197384ca7670SDamien Bergamini 	/*
197484ca7670SDamien Bergamini 	 * Avoid re-entrant calls.  We need to release the mutex in ipw_init()
197584ca7670SDamien Bergamini 	 * when loading the firmware and we don't want to be called during this
197684ca7670SDamien Bergamini 	 * operation.
197784ca7670SDamien Bergamini 	 */
197884ca7670SDamien Bergamini 	if (sc->flags & IPW_FLAG_INIT_LOCKED) {
197984ca7670SDamien Bergamini 		if (!owned)
198084ca7670SDamien Bergamini 			mtx_unlock(&sc->sc_mtx);
1981ceaec73dSDamien Bergamini 		return;
1982ceaec73dSDamien Bergamini 	}
198384ca7670SDamien Bergamini 	sc->flags |= IPW_FLAG_INIT_LOCKED;
1984ceaec73dSDamien Bergamini 
1985ceaec73dSDamien Bergamini 	ipw_stop(sc);
1986ceaec73dSDamien Bergamini 
1987ceaec73dSDamien Bergamini 	if (ipw_reset(sc) != 0) {
1988ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not reset adapter\n");
198984ca7670SDamien Bergamini 		goto fail1;
1990ceaec73dSDamien Bergamini 	}
1991ceaec73dSDamien Bergamini 
199284ca7670SDamien Bergamini 	switch (ic->ic_opmode) {
199384ca7670SDamien Bergamini 	case IEEE80211_M_STA:
199484ca7670SDamien Bergamini 		imagename = "ipw_bss";
199584ca7670SDamien Bergamini 		break;
199684ca7670SDamien Bergamini 	case IEEE80211_M_IBSS:
199784ca7670SDamien Bergamini 		imagename = "ipw_ibss";
199884ca7670SDamien Bergamini 		break;
199984ca7670SDamien Bergamini 	case IEEE80211_M_MONITOR:
200084ca7670SDamien Bergamini 		imagename = "ipw_monitor";
200184ca7670SDamien Bergamini 		break;
200284ca7670SDamien Bergamini 	default:
200384ca7670SDamien Bergamini 		imagename = NULL;	/* should not get there */
200484ca7670SDamien Bergamini 	}
200584ca7670SDamien Bergamini 
200684ca7670SDamien Bergamini 	/*
200784ca7670SDamien Bergamini 	 * Load firmware image using the firmware(9) subsystem.  We need to
200884ca7670SDamien Bergamini 	 * release the driver's lock first.
200984ca7670SDamien Bergamini 	 */
2010cbe2bd55SIan Dowse 	if (sc->sc_firmware == NULL || strcmp(sc->sc_firmware->name,
2011cbe2bd55SIan Dowse 	    imagename) != 0) {
201284ca7670SDamien Bergamini 		mtx_unlock(&sc->sc_mtx);
2013cbe2bd55SIan Dowse 		if (sc->sc_firmware != NULL)
2014cbe2bd55SIan Dowse 			firmware_put(sc->sc_firmware, FIRMWARE_UNLOAD);
2015cbe2bd55SIan Dowse 		sc->sc_firmware = firmware_get(imagename);
201684ca7670SDamien Bergamini 		mtx_lock(&sc->sc_mtx);
2017cbe2bd55SIan Dowse 	}
201884ca7670SDamien Bergamini 
2019cbe2bd55SIan Dowse 	if (sc->sc_firmware == NULL) {
202084ca7670SDamien Bergamini 		device_printf(sc->sc_dev,
202184ca7670SDamien Bergamini 		    "could not load firmware image '%s'\n", imagename);
202284ca7670SDamien Bergamini 		goto fail1;
202384ca7670SDamien Bergamini 	}
202484ca7670SDamien Bergamini 
2025cbe2bd55SIan Dowse 	fp = sc->sc_firmware;
202684ca7670SDamien Bergamini 	if (fp->datasize < sizeof *hdr) {
202784ca7670SDamien Bergamini 		device_printf(sc->sc_dev,
202884ca7670SDamien Bergamini 		    "firmware image too short %zu\n", fp->datasize);
202984ca7670SDamien Bergamini 		goto fail2;
203084ca7670SDamien Bergamini 	}
203184ca7670SDamien Bergamini 
203284ca7670SDamien Bergamini 	hdr = (const struct ipw_firmware_hdr *)fp->data;
203384ca7670SDamien Bergamini 
203484ca7670SDamien Bergamini 	if (fp->datasize < sizeof *hdr + le32toh(hdr->mainsz) +
203584ca7670SDamien Bergamini 	    le32toh(hdr->ucodesz)) {
203684ca7670SDamien Bergamini 		device_printf(sc->sc_dev,
203784ca7670SDamien Bergamini 		    "firmware image too short %zu\n", fp->datasize);
203884ca7670SDamien Bergamini 		goto fail2;
203984ca7670SDamien Bergamini 	}
204084ca7670SDamien Bergamini 
204184ca7670SDamien Bergamini 	fw = (const char *)fp->data + sizeof *hdr + le32toh(hdr->mainsz);
204284ca7670SDamien Bergamini 	if (ipw_load_ucode(sc, fw, le32toh(hdr->ucodesz)) != 0) {
2043ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load microcode\n");
204484ca7670SDamien Bergamini 		goto fail2;
2045ceaec73dSDamien Bergamini 	}
2046ceaec73dSDamien Bergamini 
2047ceaec73dSDamien Bergamini 	ipw_stop_master(sc);
2048ceaec73dSDamien Bergamini 
2049ceaec73dSDamien Bergamini 	/*
2050ceaec73dSDamien Bergamini 	 * Setup tx, rx and status rings.
2051ceaec73dSDamien Bergamini 	 */
2052ceaec73dSDamien Bergamini 	sc->txold = IPW_NTBD - 1;
2053ceaec73dSDamien Bergamini 	sc->txcur = 0;
2054ceaec73dSDamien Bergamini 	sc->txfree = IPW_NTBD - 2;
2055ceaec73dSDamien Bergamini 	sc->rxcur = IPW_NRBD - 1;
2056ceaec73dSDamien Bergamini 
2057ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_TX_BASE,  sc->tbd_phys);
2058ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_TX_SIZE,  IPW_NTBD);
2059ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_TX_READ,  0);
2060ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_TX_WRITE, sc->txcur);
2061ceaec73dSDamien Bergamini 
2062ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_RX_BASE,  sc->rbd_phys);
2063ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_RX_SIZE,  IPW_NRBD);
2064ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_RX_READ,  0);
2065ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_RX_WRITE, sc->rxcur);
2066ceaec73dSDamien Bergamini 
2067ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_STATUS_BASE, sc->status_phys);
2068ceaec73dSDamien Bergamini 
206984ca7670SDamien Bergamini 	fw = (const char *)fp->data + sizeof *hdr;
207084ca7670SDamien Bergamini 	if (ipw_load_firmware(sc, fw, le32toh(hdr->mainsz)) != 0) {
2071ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load firmware\n");
207284ca7670SDamien Bergamini 		goto fail2;
2073ceaec73dSDamien Bergamini 	}
2074ceaec73dSDamien Bergamini 
2075ceaec73dSDamien Bergamini 	sc->flags |= IPW_FLAG_FW_INITED;
2076ceaec73dSDamien Bergamini 
2077ceaec73dSDamien Bergamini 	/* retrieve information tables base addresses */
2078ceaec73dSDamien Bergamini 	sc->table1_base = CSR_READ_4(sc, IPW_CSR_TABLE1_BASE);
2079ceaec73dSDamien Bergamini 	sc->table2_base = CSR_READ_4(sc, IPW_CSR_TABLE2_BASE);
2080ceaec73dSDamien Bergamini 
2081ceaec73dSDamien Bergamini 	ipw_write_table1(sc, IPW_INFO_LOCK, 0);
2082ceaec73dSDamien Bergamini 
2083ceaec73dSDamien Bergamini 	if (ipw_config(sc) != 0) {
2084ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "device configuration failed\n");
208584ca7670SDamien Bergamini 		goto fail1;
2086ceaec73dSDamien Bergamini 	}
2087ceaec73dSDamien Bergamini 
208813f4c340SRobert Watson 	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
208913f4c340SRobert Watson 	ifp->if_drv_flags |= IFF_DRV_RUNNING;
2090ceaec73dSDamien Bergamini 
209184ca7670SDamien Bergamini 	sc->flags &=~ IPW_FLAG_INIT_LOCKED;
209284ca7670SDamien Bergamini 
209384ca7670SDamien Bergamini 	if (!owned)
209484ca7670SDamien Bergamini 		mtx_unlock(&sc->sc_mtx);
209584ca7670SDamien Bergamini 
2096ceaec73dSDamien Bergamini 	return;
2097ceaec73dSDamien Bergamini 
209884ca7670SDamien Bergamini fail2:	firmware_put(fp, FIRMWARE_UNLOAD);
2099cbe2bd55SIan Dowse 	sc->sc_firmware = NULL;
210084ca7670SDamien Bergamini fail1:	ifp->if_flags &= ~IFF_UP;
2101ceaec73dSDamien Bergamini 	ipw_stop(sc);
210284ca7670SDamien Bergamini 	sc->flags &=~ IPW_FLAG_INIT_LOCKED;
210384ca7670SDamien Bergamini 	if (!owned)
210484ca7670SDamien Bergamini 		mtx_unlock(&sc->sc_mtx);
2105ceaec73dSDamien Bergamini }
2106ceaec73dSDamien Bergamini 
2107ceaec73dSDamien Bergamini static void
2108ceaec73dSDamien Bergamini ipw_stop(void *priv)
2109ceaec73dSDamien Bergamini {
2110ceaec73dSDamien Bergamini 	struct ipw_softc *sc = priv;
2111ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2112ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
2113ceaec73dSDamien Bergamini 	int i;
2114ceaec73dSDamien Bergamini 
211584ca7670SDamien Bergamini 	mtx_lock(&sc->sc_mtx);
211684ca7670SDamien Bergamini 
211784ca7670SDamien Bergamini 	ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
211884ca7670SDamien Bergamini 
2119ceaec73dSDamien Bergamini 	ipw_stop_master(sc);
2120ceaec73dSDamien Bergamini 
2121ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_RST, IPW_RST_SW_RESET);
2122ceaec73dSDamien Bergamini 
2123ceaec73dSDamien Bergamini 	/*
2124ceaec73dSDamien Bergamini 	 * Release tx buffers.
2125ceaec73dSDamien Bergamini 	 */
2126ceaec73dSDamien Bergamini 	for (i = 0; i < IPW_NTBD; i++)
2127ceaec73dSDamien Bergamini 		ipw_release_sbd(sc, &sc->stbd_list[i]);
2128ceaec73dSDamien Bergamini 
2129ceaec73dSDamien Bergamini 	sc->sc_tx_timer = 0;
2130ceaec73dSDamien Bergamini 	ifp->if_timer = 0;
213113f4c340SRobert Watson 	ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
2132ceaec73dSDamien Bergamini 
213384ca7670SDamien Bergamini 	mtx_unlock(&sc->sc_mtx);
2134ceaec73dSDamien Bergamini }
2135ceaec73dSDamien Bergamini 
2136ceaec73dSDamien Bergamini static int
2137ceaec73dSDamien Bergamini ipw_sysctl_stats(SYSCTL_HANDLER_ARGS)
2138ceaec73dSDamien Bergamini {
2139ceaec73dSDamien Bergamini 	struct ipw_softc *sc = arg1;
2140ceaec73dSDamien Bergamini 	uint32_t i, size, buf[256];
2141ceaec73dSDamien Bergamini 
2142ceaec73dSDamien Bergamini 	if (!(sc->flags & IPW_FLAG_FW_INITED)) {
21433afda804SDamien Bergamini 		memset(buf, 0, sizeof buf);
2144ceaec73dSDamien Bergamini 		return SYSCTL_OUT(req, buf, sizeof buf);
2145ceaec73dSDamien Bergamini 	}
2146ceaec73dSDamien Bergamini 
2147ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IPW_CSR_AUTOINC_ADDR, sc->table1_base);
2148ceaec73dSDamien Bergamini 
2149ceaec73dSDamien Bergamini 	size = min(CSR_READ_4(sc, IPW_CSR_AUTOINC_DATA), 256);
2150ceaec73dSDamien Bergamini 	for (i = 1; i < size; i++)
2151ceaec73dSDamien Bergamini 		buf[i] = MEM_READ_4(sc, CSR_READ_4(sc, IPW_CSR_AUTOINC_DATA));
2152ceaec73dSDamien Bergamini 
2153ceaec73dSDamien Bergamini 	return SYSCTL_OUT(req, buf, sizeof buf);
2154ceaec73dSDamien Bergamini }
2155ceaec73dSDamien Bergamini 
2156ceaec73dSDamien Bergamini static int
2157ceaec73dSDamien Bergamini ipw_sysctl_radio(SYSCTL_HANDLER_ARGS)
2158ceaec73dSDamien Bergamini {
2159ceaec73dSDamien Bergamini 	struct ipw_softc *sc = arg1;
2160ceaec73dSDamien Bergamini 	int val;
2161ceaec73dSDamien Bergamini 
2162ceaec73dSDamien Bergamini 	val = !((sc->flags & IPW_FLAG_HAS_RADIO_SWITCH) &&
2163ceaec73dSDamien Bergamini 	        (CSR_READ_4(sc, IPW_CSR_IO) & IPW_IO_RADIO_DISABLED));
2164ceaec73dSDamien Bergamini 
2165ceaec73dSDamien Bergamini 	return SYSCTL_OUT(req, &val, sizeof val);
2166ceaec73dSDamien Bergamini }
2167ceaec73dSDamien Bergamini 
2168ceaec73dSDamien Bergamini static uint32_t
2169ceaec73dSDamien Bergamini ipw_read_table1(struct ipw_softc *sc, uint32_t off)
2170ceaec73dSDamien Bergamini {
2171ceaec73dSDamien Bergamini 	return MEM_READ_4(sc, MEM_READ_4(sc, sc->table1_base + off));
2172ceaec73dSDamien Bergamini }
2173ceaec73dSDamien Bergamini 
2174ceaec73dSDamien Bergamini static void
2175ceaec73dSDamien Bergamini ipw_write_table1(struct ipw_softc *sc, uint32_t off, uint32_t info)
2176ceaec73dSDamien Bergamini {
2177ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, MEM_READ_4(sc, sc->table1_base + off), info);
2178ceaec73dSDamien Bergamini }
2179ceaec73dSDamien Bergamini 
2180ceaec73dSDamien Bergamini static int
2181ceaec73dSDamien Bergamini ipw_read_table2(struct ipw_softc *sc, uint32_t off, void *buf, uint32_t *len)
2182ceaec73dSDamien Bergamini {
2183ceaec73dSDamien Bergamini 	uint32_t addr, info;
2184ceaec73dSDamien Bergamini 	uint16_t count, size;
2185ceaec73dSDamien Bergamini 	uint32_t total;
2186ceaec73dSDamien Bergamini 
2187ceaec73dSDamien Bergamini 	/* addr[4] + count[2] + size[2] */
2188ceaec73dSDamien Bergamini 	addr = MEM_READ_4(sc, sc->table2_base + off);
2189ceaec73dSDamien Bergamini 	info = MEM_READ_4(sc, sc->table2_base + off + 4);
2190ceaec73dSDamien Bergamini 
2191ceaec73dSDamien Bergamini 	count = info >> 16;
2192ceaec73dSDamien Bergamini 	size = info & 0xffff;
2193ceaec73dSDamien Bergamini 	total = count * size;
2194ceaec73dSDamien Bergamini 
2195ceaec73dSDamien Bergamini 	if (total > *len) {
2196ceaec73dSDamien Bergamini 		*len = total;
2197ceaec73dSDamien Bergamini 		return EINVAL;
2198ceaec73dSDamien Bergamini 	}
2199ceaec73dSDamien Bergamini 
2200ceaec73dSDamien Bergamini 	*len = total;
2201ceaec73dSDamien Bergamini 	ipw_read_mem_1(sc, addr, buf, total);
2202ceaec73dSDamien Bergamini 
2203ceaec73dSDamien Bergamini 	return 0;
2204ceaec73dSDamien Bergamini }
2205ceaec73dSDamien Bergamini 
2206ceaec73dSDamien Bergamini static void
2207ceaec73dSDamien Bergamini ipw_read_mem_1(struct ipw_softc *sc, bus_size_t offset, uint8_t *datap,
2208ceaec73dSDamien Bergamini     bus_size_t count)
2209ceaec73dSDamien Bergamini {
2210ceaec73dSDamien Bergamini 	for (; count > 0; offset++, datap++, count--) {
2211ceaec73dSDamien Bergamini 		CSR_WRITE_4(sc, IPW_CSR_INDIRECT_ADDR, offset & ~3);
2212ceaec73dSDamien Bergamini 		*datap = CSR_READ_1(sc, IPW_CSR_INDIRECT_DATA + (offset & 3));
2213ceaec73dSDamien Bergamini 	}
2214ceaec73dSDamien Bergamini }
2215ceaec73dSDamien Bergamini 
2216ceaec73dSDamien Bergamini static void
221784ca7670SDamien Bergamini ipw_write_mem_1(struct ipw_softc *sc, bus_size_t offset, const uint8_t *datap,
2218ceaec73dSDamien Bergamini     bus_size_t count)
2219ceaec73dSDamien Bergamini {
2220ceaec73dSDamien Bergamini 	for (; count > 0; offset++, datap++, count--) {
2221ceaec73dSDamien Bergamini 		CSR_WRITE_4(sc, IPW_CSR_INDIRECT_ADDR, offset & ~3);
2222ceaec73dSDamien Bergamini 		CSR_WRITE_1(sc, IPW_CSR_INDIRECT_DATA + (offset & 3), *datap);
2223ceaec73dSDamien Bergamini 	}
2224ceaec73dSDamien Bergamini }
2225