xref: /titanic_51/usr/src/uts/common/io/rtw/rtw.c (revision 4cf02d40c1d09ad2a5a49f040d1c9fa191244416)
1 /*
2  * Copyright 2009 Sun Microsystems, Inc.  All rights reserved.
3  * Use is subject to license terms.
4  */
5 
6 /*
7  * Copyright (c) 2004 David Young.  All rights reserved.
8  *
9  * This code was written by David Young.
10  *
11  * Redistribution and use in source and binary forms, with or without
12  * modification, are permitted provided that the following conditions
13  * are met:
14  * 1. Redistributions of source code must retain the above copyright
15  *    notice, this list of conditions and the following disclaimer.
16  * 2. Redistributions in binary form must reproduce the above copyright
17  *    notice, this list of conditions and the following disclaimer in the
18  *    documentation and/or other materials provided with the distribution.
19  * 3. Neither the name of the author nor the names of any co-contributors
20  *    may be used to endorse or promote products derived from this software
21  *    without specific prior written permission.
22  *
23  * THIS SOFTWARE IS PROVIDED BY David Young ``AS IS'' AND ANY
24  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
25  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
26  * PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL David
27  * Young BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
28  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
29  * TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
30  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
31  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
32  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
33  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
34  * OF SUCH DAMAGE.
35  */
36 #include <sys/sysmacros.h>
37 #include <sys/pci.h>
38 #include <sys/stat.h>
39 #include <sys/strsubr.h>
40 #include <sys/strsun.h>
41 #include <sys/mac_provider.h>
42 #include <sys/mac_wifi.h>
43 #include <sys/net80211.h>
44 #include "rtwreg.h"
45 #include "rtwvar.h"
46 #include "smc93cx6var.h"
47 #include "rtwphy.h"
48 #include "rtwphyio.h"
49 
50 /*
51  * PIO access attributes for registers
52  */
53 static ddi_device_acc_attr_t rtw_reg_accattr = {
54 	DDI_DEVICE_ATTR_V0,
55 	DDI_STRUCTURE_LE_ACC,
56 	DDI_STRICTORDER_ACC,
57 	DDI_DEFAULT_ACC
58 };
59 
60 /*
61  * DMA access attributes for descriptors and bufs: NOT to be byte swapped.
62  */
63 static ddi_device_acc_attr_t rtw_desc_accattr = {
64 	DDI_DEVICE_ATTR_V0,
65 	DDI_NEVERSWAP_ACC,
66 	DDI_STRICTORDER_ACC,
67 	DDI_DEFAULT_ACC
68 };
69 static ddi_device_acc_attr_t rtw_buf_accattr = {
70 	DDI_DEVICE_ATTR_V0,
71 	DDI_NEVERSWAP_ACC,
72 	DDI_STRICTORDER_ACC,
73 	DDI_DEFAULT_ACC
74 };
75 
76 /*
77  * Describes the chip's DMA engine
78  */
79 static ddi_dma_attr_t dma_attr_desc = {
80 	DMA_ATTR_V0,			/* dma_attr version */
81 	0x0000000000000000ull,		/* dma_attr_addr_lo */
82 	0xFFFFFFFF,			/* dma_attr_addr_hi */
83 	0x00000000FFFFFFFFull,		/* dma_attr_count_max */
84 	0x100,				/* dma_attr_align */
85 	0xFFFFFFFF,			/* dma_attr_burstsizes */
86 	0x00000001,			/* dma_attr_minxfer */
87 	0x00000000FFFFull,		/* dma_attr_maxxfer */
88 	0xFFFFFFFFFFFFFFFFull,		/* dma_attr_seg */
89 	1,				/* dma_attr_sgllen */
90 	1,				/* dma_attr_granular */
91 	0				/* dma_attr_flags */
92 };
93 
94 static ddi_dma_attr_t dma_attr_rxbuf = {
95 	DMA_ATTR_V0,			/* dma_attr version */
96 	0x0000000000000000ull,		/* dma_attr_addr_lo */
97 	0xFFFFFFFF,			/* dma_attr_addr_hi */
98 	0x00000000FFFFFFFFull,		/* dma_attr_count_max */
99 	(uint32_t)16,			/* dma_attr_align */
100 	0xFFFFFFFF,			/* dma_attr_burstsizes */
101 	0x00000001,			/* dma_attr_minxfer */
102 	0x00000000FFFFull,		/* dma_attr_maxxfer */
103 	0xFFFFFFFFFFFFFFFFull,		/* dma_attr_seg */
104 	1,				/* dma_attr_sgllen */
105 	1,				/* dma_attr_granular */
106 	0				/* dma_attr_flags */
107 };
108 
109 static ddi_dma_attr_t dma_attr_txbuf = {
110 	DMA_ATTR_V0,			/* dma_attr version */
111 	0x0000000000000000ull,		/* dma_attr_addr_lo */
112 	0xFFFFFFFF,			/* dma_attr_addr_hi */
113 	0x00000000FFFFFFFFull,		/* dma_attr_count_max */
114 	(uint32_t)16,			/* dma_attr_align */
115 	0xFFFFFFFF,			/* dma_attr_burstsizes */
116 	0x00000001,			/* dma_attr_minxfer */
117 	0x00000000FFFFull,		/* dma_attr_maxxfer */
118 	0xFFFFFFFFFFFFFFFFull,		/* dma_attr_seg */
119 	1,				/* dma_attr_sgllen */
120 	1,				/* dma_attr_granular */
121 	0				/* dma_attr_flags */
122 };
123 
124 
125 static void *rtw_soft_state_p = NULL;
126 
127 static void	rtw_stop(void *);
128 static int	rtw_attach(dev_info_t *, ddi_attach_cmd_t);
129 static int	rtw_detach(dev_info_t *, ddi_detach_cmd_t);
130 static int	rtw_quiesce(dev_info_t *);
131 static int	rtw_m_stat(void *,  uint_t, uint64_t *);
132 static int	rtw_m_start(void *);
133 static void	rtw_m_stop(void *);
134 static int	rtw_m_promisc(void *, boolean_t);
135 static int	rtw_m_multicst(void *, boolean_t, const uint8_t *);
136 static int	rtw_m_unicst(void *, const uint8_t *);
137 static mblk_t	*rtw_m_tx(void *, mblk_t *);
138 static void	rtw_m_ioctl(void *, queue_t *, mblk_t *);
139 static int	rtw_m_setprop(void *, const char *, mac_prop_id_t,
140     uint_t, const void *);
141 static int	rtw_m_getprop(void *, const char *, mac_prop_id_t,
142     uint_t, uint_t, void *, uint_t *);
143 
144 static mac_callbacks_t rtw_m_callbacks = {
145 	MC_IOCTL | MC_SETPROP | MC_GETPROP,
146 	rtw_m_stat,
147 	rtw_m_start,
148 	rtw_m_stop,
149 	rtw_m_promisc,
150 	rtw_m_multicst,
151 	rtw_m_unicst,
152 	rtw_m_tx,
153 	rtw_m_ioctl,
154 	NULL,		/* mc_getcapab */
155 	NULL,
156 	NULL,
157 	rtw_m_setprop,
158 	rtw_m_getprop
159 };
160 
161 DDI_DEFINE_STREAM_OPS(rtw_dev_ops, nulldev, nulldev, rtw_attach, rtw_detach,
162     nodev, NULL, D_MP, NULL, rtw_quiesce);
163 
164 static struct modldrv rtw_modldrv = {
165 	&mod_driverops,		/* Type of module.  This one is a driver */
166 	"realtek 8180L driver 1.7",	/* short description */
167 	&rtw_dev_ops		/* driver specific ops */
168 };
169 
170 static struct modlinkage modlinkage = {
171 	MODREV_1, (void *)&rtw_modldrv, NULL
172 };
173 
174 static uint32_t rtw_qlen[RTW_NTXPRI] = {
175 	RTW_TXQLENLO,
176 	RTW_TXQLENMD,
177 	RTW_TXQLENHI,
178 	RTW_TXQLENBCN
179 };
180 
181 uint32_t rtw_dbg_flags = 0;
182 	/*
183 	 * RTW_DEBUG_ATTACH | RTW_DEBUG_TUNE |
184 	 * RTW_DEBUG_ACCESS | RTW_DEBUG_INIT | RTW_DEBUG_PKTFILT |
185 	 * RTW_DEBUG_RECV | RTW_DEBUG_XMIT | RTW_DEBUG_80211 | RTW_DEBUG_INTR |
186 	 * RTW_DEBUG_PKTDUMP;
187 	 */
188 
189 /*
190  * Supported rates for 802.11b modes (in 500Kbps unit).
191  */
192 static const struct ieee80211_rateset rtw_rateset_11b =
193 	{ 4, { 2, 4, 11, 22 } };
194 
195 int
196 _info(struct modinfo *modinfop)
197 {
198 	return (mod_info(&modlinkage, modinfop));
199 }
200 
201 int
202 _init(void)
203 {
204 	int status;
205 
206 	status = ddi_soft_state_init(&rtw_soft_state_p,
207 	    sizeof (rtw_softc_t), 1);
208 	if (status != 0)
209 		return (status);
210 
211 	mac_init_ops(&rtw_dev_ops, "rtw");
212 	status = mod_install(&modlinkage);
213 	if (status != 0) {
214 		mac_fini_ops(&rtw_dev_ops);
215 		ddi_soft_state_fini(&rtw_soft_state_p);
216 	}
217 	return (status);
218 }
219 
220 int
221 _fini(void)
222 {
223 	int status;
224 
225 	status = mod_remove(&modlinkage);
226 	if (status == 0) {
227 		mac_fini_ops(&rtw_dev_ops);
228 		ddi_soft_state_fini(&rtw_soft_state_p);
229 	}
230 	return (status);
231 }
232 
233 void
234 rtw_dbg(uint32_t dbg_flags, const int8_t *fmt, ...)
235 {
236 	va_list args;
237 
238 	if (dbg_flags & rtw_dbg_flags) {
239 		va_start(args, fmt);
240 		vcmn_err(CE_CONT, fmt, args);
241 		va_end(args);
242 	}
243 }
244 
245 #ifdef DEBUG
246 static void
247 rtw_print_regs(struct rtw_regs *regs, const char *dvname, const char *where)
248 {
249 #define	PRINTREG32(sc, reg)				\
250 	RTW_DPRINTF(RTW_DEBUG_REGDUMP,			\
251 	    "%s: reg[ " #reg " / %03x ] = %08x\n",	\
252 	    dvname, reg, RTW_READ(regs, reg))
253 
254 #define	PRINTREG16(sc, reg)				\
255 	RTW_DPRINTF(RTW_DEBUG_REGDUMP,			\
256 	    "%s: reg[ " #reg " / %03x ] = %04x\n",	\
257 	    dvname, reg, RTW_READ16(regs, reg))
258 
259 #define	PRINTREG8(sc, reg)				\
260 	RTW_DPRINTF(RTW_DEBUG_REGDUMP,			\
261 	    "%s: reg[ " #reg " / %03x ] = %02x\n",	\
262 	    dvname, reg, RTW_READ8(regs, reg))
263 
264 	RTW_DPRINTF(RTW_DEBUG_REGDUMP, "%s: %s\n", dvname, where);
265 
266 	PRINTREG32(regs, RTW_IDR0);
267 	PRINTREG32(regs, RTW_IDR1);
268 	PRINTREG32(regs, RTW_MAR0);
269 	PRINTREG32(regs, RTW_MAR1);
270 	PRINTREG32(regs, RTW_TSFTRL);
271 	PRINTREG32(regs, RTW_TSFTRH);
272 	PRINTREG32(regs, RTW_TLPDA);
273 	PRINTREG32(regs, RTW_TNPDA);
274 	PRINTREG32(regs, RTW_THPDA);
275 	PRINTREG32(regs, RTW_TCR);
276 	PRINTREG32(regs, RTW_RCR);
277 	PRINTREG32(regs, RTW_TINT);
278 	PRINTREG32(regs, RTW_TBDA);
279 	PRINTREG32(regs, RTW_ANAPARM);
280 	PRINTREG32(regs, RTW_BB);
281 	PRINTREG32(regs, RTW_PHYCFG);
282 	PRINTREG32(regs, RTW_WAKEUP0L);
283 	PRINTREG32(regs, RTW_WAKEUP0H);
284 	PRINTREG32(regs, RTW_WAKEUP1L);
285 	PRINTREG32(regs, RTW_WAKEUP1H);
286 	PRINTREG32(regs, RTW_WAKEUP2LL);
287 	PRINTREG32(regs, RTW_WAKEUP2LH);
288 	PRINTREG32(regs, RTW_WAKEUP2HL);
289 	PRINTREG32(regs, RTW_WAKEUP2HH);
290 	PRINTREG32(regs, RTW_WAKEUP3LL);
291 	PRINTREG32(regs, RTW_WAKEUP3LH);
292 	PRINTREG32(regs, RTW_WAKEUP3HL);
293 	PRINTREG32(regs, RTW_WAKEUP3HH);
294 	PRINTREG32(regs, RTW_WAKEUP4LL);
295 	PRINTREG32(regs, RTW_WAKEUP4LH);
296 	PRINTREG32(regs, RTW_WAKEUP4HL);
297 	PRINTREG32(regs, RTW_WAKEUP4HH);
298 	PRINTREG32(regs, RTW_DK0);
299 	PRINTREG32(regs, RTW_DK1);
300 	PRINTREG32(regs, RTW_DK2);
301 	PRINTREG32(regs, RTW_DK3);
302 	PRINTREG32(regs, RTW_RETRYCTR);
303 	PRINTREG32(regs, RTW_RDSAR);
304 	PRINTREG32(regs, RTW_FER);
305 	PRINTREG32(regs, RTW_FEMR);
306 	PRINTREG32(regs, RTW_FPSR);
307 	PRINTREG32(regs, RTW_FFER);
308 
309 	/* 16-bit registers */
310 	PRINTREG16(regs, RTW_BRSR);
311 	PRINTREG16(regs, RTW_IMR);
312 	PRINTREG16(regs, RTW_ISR);
313 	PRINTREG16(regs, RTW_BCNITV);
314 	PRINTREG16(regs, RTW_ATIMWND);
315 	PRINTREG16(regs, RTW_BINTRITV);
316 	PRINTREG16(regs, RTW_ATIMTRITV);
317 	PRINTREG16(regs, RTW_CRC16ERR);
318 	PRINTREG16(regs, RTW_CRC0);
319 	PRINTREG16(regs, RTW_CRC1);
320 	PRINTREG16(regs, RTW_CRC2);
321 	PRINTREG16(regs, RTW_CRC3);
322 	PRINTREG16(regs, RTW_CRC4);
323 	PRINTREG16(regs, RTW_CWR);
324 
325 	/* 8-bit registers */
326 	PRINTREG8(regs, RTW_CR);
327 	PRINTREG8(regs, RTW_9346CR);
328 	PRINTREG8(regs, RTW_CONFIG0);
329 	PRINTREG8(regs, RTW_CONFIG1);
330 	PRINTREG8(regs, RTW_CONFIG2);
331 	PRINTREG8(regs, RTW_MSR);
332 	PRINTREG8(regs, RTW_CONFIG3);
333 	PRINTREG8(regs, RTW_CONFIG4);
334 	PRINTREG8(regs, RTW_TESTR);
335 	PRINTREG8(regs, RTW_PSR);
336 	PRINTREG8(regs, RTW_SCR);
337 	PRINTREG8(regs, RTW_PHYDELAY);
338 	PRINTREG8(regs, RTW_CRCOUNT);
339 	PRINTREG8(regs, RTW_PHYADDR);
340 	PRINTREG8(regs, RTW_PHYDATAW);
341 	PRINTREG8(regs, RTW_PHYDATAR);
342 	PRINTREG8(regs, RTW_CONFIG5);
343 	PRINTREG8(regs, RTW_TPPOLL);
344 
345 	PRINTREG16(regs, RTW_BSSID16);
346 	PRINTREG32(regs, RTW_BSSID32);
347 #undef PRINTREG32
348 #undef PRINTREG16
349 #undef PRINTREG8
350 }
351 
352 #endif /* DEBUG */
353 static const char *
354 rtw_access_string(enum rtw_access access)
355 {
356 	switch (access) {
357 	case RTW_ACCESS_NONE:
358 		return ("none");
359 	case RTW_ACCESS_CONFIG:
360 		return ("config");
361 	case RTW_ACCESS_ANAPARM:
362 		return ("anaparm");
363 	default:
364 		return ("unknown");
365 	}
366 }
367 
368 /*
369  * Enable registers, switch register banks.
370  */
371 void
372 rtw_config0123_enable(struct rtw_regs *regs, int enable)
373 {
374 	uint8_t ecr;
375 	ecr = RTW_READ8(regs, RTW_9346CR);
376 	ecr &= ~(RTW_9346CR_EEM_MASK | RTW_9346CR_EECS | RTW_9346CR_EESK);
377 	if (enable)
378 		ecr |= RTW_9346CR_EEM_CONFIG;
379 	else {
380 		RTW_WBW(regs, RTW_9346CR, MAX(RTW_CONFIG0, RTW_CONFIG3));
381 		ecr |= RTW_9346CR_EEM_NORMAL;
382 	}
383 	RTW_WRITE8(regs, RTW_9346CR, ecr);
384 	RTW_SYNC(regs, RTW_9346CR, RTW_9346CR);
385 }
386 
387 /*
388  * requires rtw_config0123_enable(, 1)
389  */
390 void
391 rtw_anaparm_enable(struct rtw_regs *regs, int enable)
392 {
393 	uint8_t cfg3;
394 
395 	cfg3 = RTW_READ8(regs, RTW_CONFIG3);
396 	cfg3 |= RTW_CONFIG3_CLKRUNEN;
397 	if (enable)
398 		cfg3 |= RTW_CONFIG3_PARMEN;
399 	else
400 		cfg3 &= ~RTW_CONFIG3_PARMEN;
401 	RTW_WRITE8(regs, RTW_CONFIG3, cfg3);
402 	RTW_SYNC(regs, RTW_CONFIG3, RTW_CONFIG3);
403 }
404 
405 /*
406  * requires rtw_anaparm_enable(, 1)
407  */
408 void
409 rtw_txdac_enable(rtw_softc_t *rsc, int enable)
410 {
411 	uint32_t anaparm;
412 	struct rtw_regs *regs = &rsc->sc_regs;
413 
414 	anaparm = RTW_READ(regs, RTW_ANAPARM);
415 	if (enable)
416 		anaparm &= ~RTW_ANAPARM_TXDACOFF;
417 	else
418 		anaparm |= RTW_ANAPARM_TXDACOFF;
419 	RTW_WRITE(regs, RTW_ANAPARM, anaparm);
420 	RTW_SYNC(regs, RTW_ANAPARM, RTW_ANAPARM);
421 }
422 
423 static void
424 rtw_set_access1(struct rtw_regs *regs, enum rtw_access naccess)
425 {
426 	ASSERT(naccess >= RTW_ACCESS_NONE && naccess <= RTW_ACCESS_ANAPARM);
427 	ASSERT(regs->r_access >= RTW_ACCESS_NONE &&
428 	    regs->r_access <= RTW_ACCESS_ANAPARM);
429 
430 	if (naccess == regs->r_access)
431 		return;
432 
433 	switch (naccess) {
434 	case RTW_ACCESS_NONE:
435 		switch (regs->r_access) {
436 		case RTW_ACCESS_ANAPARM:
437 			rtw_anaparm_enable(regs, 0);
438 			/*FALLTHROUGH*/
439 		case RTW_ACCESS_CONFIG:
440 			rtw_config0123_enable(regs, 0);
441 			/*FALLTHROUGH*/
442 		case RTW_ACCESS_NONE:
443 			break;
444 		}
445 		break;
446 	case RTW_ACCESS_CONFIG:
447 		switch (regs->r_access) {
448 		case RTW_ACCESS_NONE:
449 			rtw_config0123_enable(regs, 1);
450 			/*FALLTHROUGH*/
451 		case RTW_ACCESS_CONFIG:
452 			break;
453 		case RTW_ACCESS_ANAPARM:
454 			rtw_anaparm_enable(regs, 0);
455 			break;
456 		}
457 		break;
458 	case RTW_ACCESS_ANAPARM:
459 		switch (regs->r_access) {
460 		case RTW_ACCESS_NONE:
461 			rtw_config0123_enable(regs, 1);
462 			/*FALLTHROUGH*/
463 		case RTW_ACCESS_CONFIG:
464 			rtw_anaparm_enable(regs, 1);
465 			/*FALLTHROUGH*/
466 		case RTW_ACCESS_ANAPARM:
467 			break;
468 		}
469 		break;
470 	}
471 }
472 
473 void
474 rtw_set_access(struct rtw_regs *regs, enum rtw_access access)
475 {
476 	rtw_set_access1(regs, access);
477 	RTW_DPRINTF(RTW_DEBUG_ACCESS,
478 	    "%s: access %s -> %s\n", __func__,
479 	    rtw_access_string(regs->r_access),
480 	    rtw_access_string(access));
481 	regs->r_access = access;
482 }
483 
484 
485 void
486 rtw_continuous_tx_enable(rtw_softc_t *rsc, int enable)
487 {
488 	struct rtw_regs *regs = &rsc->sc_regs;
489 
490 	uint32_t tcr;
491 	tcr = RTW_READ(regs, RTW_TCR);
492 	tcr &= ~RTW_TCR_LBK_MASK;
493 	if (enable)
494 		tcr |= RTW_TCR_LBK_CONT;
495 	else
496 		tcr |= RTW_TCR_LBK_NORMAL;
497 	RTW_WRITE(regs, RTW_TCR, tcr);
498 	RTW_SYNC(regs, RTW_TCR, RTW_TCR);
499 	rtw_set_access(regs, RTW_ACCESS_ANAPARM);
500 	rtw_txdac_enable(rsc, !enable);
501 	rtw_set_access(regs, RTW_ACCESS_ANAPARM);
502 	rtw_set_access(regs, RTW_ACCESS_NONE);
503 }
504 
505 static int
506 rtw_chip_reset1(struct rtw_regs *regs, const char *dvname)
507 {
508 	uint8_t cr;
509 	int i;
510 
511 	RTW_WRITE8(regs, RTW_CR, RTW_CR_RST);
512 
513 	RTW_WBR(regs, RTW_CR, RTW_CR);
514 
515 	for (i = 0; i < 1000; i++) {
516 		cr = RTW_READ8(regs, RTW_CR);
517 		if ((cr & RTW_CR_RST) == 0) {
518 			RTW_DPRINTF(RTW_DEBUG_RESET,
519 			    "%s: reset in %dus\n", dvname, i);
520 			return (0);
521 		}
522 		RTW_RBR(regs, RTW_CR, RTW_CR);
523 		DELAY(10); /* 10us */
524 	}
525 
526 	cmn_err(CE_WARN, "%s: reset failed\n", dvname);
527 	return (ETIMEDOUT);
528 }
529 
530 static int
531 rtw_chip_reset(struct rtw_regs *regs, const char *dvname)
532 {
533 	RTW_WBW(regs, RTW_CR, RTW_TCR);
534 	return (rtw_chip_reset1(regs, dvname));
535 }
536 
537 static void
538 rtw_disable_interrupts(struct rtw_regs *regs)
539 {
540 	RTW_WRITE16(regs, RTW_IMR, 0);
541 	RTW_WRITE16(regs, RTW_ISR, 0xffff);
542 	(void) RTW_READ16(regs, RTW_IMR);
543 }
544 
545 static void
546 rtw_enable_interrupts(rtw_softc_t *rsc)
547 {
548 	struct rtw_regs *regs = &rsc->sc_regs;
549 
550 	rsc->sc_inten = RTW_INTR_RX | RTW_INTR_TX | RTW_INTR_IOERROR;
551 
552 	RTW_WRITE16(regs, RTW_IMR, rsc->sc_inten);
553 	RTW_WRITE16(regs, RTW_ISR, 0xffff);
554 
555 	/* XXX necessary? */
556 	if (rsc->sc_intr_ack != NULL)
557 		(*rsc->sc_intr_ack)(regs);
558 }
559 
560 static int
561 rtw_recall_eeprom(struct rtw_regs *regs, const char *dvname)
562 {
563 	int i;
564 	uint8_t ecr;
565 
566 	ecr = RTW_READ8(regs, RTW_9346CR);
567 	ecr = (ecr & ~RTW_9346CR_EEM_MASK) | RTW_9346CR_EEM_AUTOLOAD;
568 	RTW_WRITE8(regs, RTW_9346CR, ecr);
569 
570 	RTW_WBR(regs, RTW_9346CR, RTW_9346CR);
571 
572 	/* wait 25ms for completion */
573 	for (i = 0; i < 250; i++) {
574 		ecr = RTW_READ8(regs, RTW_9346CR);
575 		if ((ecr & RTW_9346CR_EEM_MASK) == RTW_9346CR_EEM_NORMAL) {
576 			RTW_DPRINTF(RTW_DEBUG_RESET,
577 			    "%s: recall EEPROM in %dus\n", dvname, i * 100);
578 			return (0);
579 		}
580 		RTW_RBR(regs, RTW_9346CR, RTW_9346CR);
581 		DELAY(100);
582 	}
583 	cmn_err(CE_WARN, "%s: recall EEPROM failed\n", dvname);
584 	return (ETIMEDOUT);
585 }
586 
587 static int
588 rtw_reset(rtw_softc_t *rsc)
589 {
590 	int rc;
591 
592 	rc = rtw_chip_reset(&rsc->sc_regs, "rtw");
593 	if (rc != 0)
594 		return (rc);
595 
596 	(void) rtw_recall_eeprom(&rsc->sc_regs, "rtw");
597 	return (0);
598 }
599 
600 void
601 rtw_set_mode(struct rtw_regs *regs, int mode)
602 {
603 	uint8_t command;
604 	command = RTW_READ8(regs, RTW_9346CR);
605 	command = command &~ RTW_EPROM_CMD_OPERATING_MODE_MASK;
606 	command = command | (mode<<RTW_EPROM_CMD_OPERATING_MODE_SHIFT);
607 	command = command &~ (1<<RTW_EPROM_CS_SHIFT);
608 	command = command &~ (1<<RTW_EPROM_CK_SHIFT);
609 	RTW_WRITE8(regs, RTW_9346CR, command);
610 }
611 
612 void
613 rtw_dma_start(struct rtw_regs *regs, int priority)
614 {
615 	uint8_t check = 0;
616 
617 	check = RTW_READ8(regs, RTW_TPPOLL);
618 	switch (priority) {
619 	case (0):
620 		RTW_WRITE8(regs, RTW_TPPOLL,
621 		    (1<< RTW_TX_DMA_POLLING_LOWPRIORITY_SHIFT) | check);
622 		break;
623 	case (1):
624 		RTW_WRITE8(regs, RTW_TPPOLL,
625 		    (1<< RTW_TX_DMA_POLLING_NORMPRIORITY_SHIFT) | check);
626 		break;
627 	case (2):
628 		RTW_WRITE8(regs, RTW_TPPOLL,
629 		    (1<< RTW_TX_DMA_POLLING_HIPRIORITY_SHIFT) | check);
630 		break;
631 	}
632 	(void) RTW_READ8(regs, RTW_TPPOLL);
633 }
634 
635 void
636 rtw_beacon_tx_disable(struct rtw_regs *regs)
637 {
638 	uint8_t mask = 0;
639 	mask |= (1 << RTW_TX_DMA_STOP_BEACON_SHIFT);
640 	rtw_set_mode(regs, RTW_EPROM_CMD_CONFIG);
641 	RTW_WRITE8(regs, RTW_TPPOLL, mask);
642 	rtw_set_mode(regs, RTW_EPROM_CMD_NORMAL);
643 }
644 
645 static void
646 rtw_io_enable(rtw_softc_t *rsc, uint8_t flags, int enable);
647 
648 void
649 rtw_rtx_disable(rtw_softc_t *rsc)
650 {
651 	struct rtw_regs *regs = &rsc->sc_regs;
652 
653 	rtw_io_enable(rsc, RTW_CR_RE|RTW_CR_TE, 0);
654 	(void) RTW_READ8(regs, RTW_CR);
655 }
656 
657 static void
658 rtw_srom_free(struct rtw_srom *sr)
659 {
660 	if (sr->sr_content == NULL)
661 		return;
662 	kmem_free(sr->sr_content, sr->sr_size);
663 	sr->sr_size = 0;
664 	sr->sr_content = NULL;
665 }
666 
667 /*ARGSUSED*/
668 static void
669 rtw_srom_defaults(struct rtw_srom *sr, uint32_t *flags, uint8_t *cs_threshold,
670     enum rtw_rfchipid *rfchipid, uint32_t *rcr)
671 {
672 	*flags |= (RTW_F_DIGPHY|RTW_F_ANTDIV);
673 	*cs_threshold = RTW_SR_ENERGYDETTHR_DEFAULT;
674 	*rcr |= RTW_RCR_ENCS1;
675 	*rfchipid = RTW_RFCHIPID_PHILIPS;
676 }
677 
678 static int
679 rtw_srom_parse(struct rtw_srom *sr, uint32_t *flags, uint8_t *cs_threshold,
680     enum rtw_rfchipid *rfchipid, uint32_t *rcr, enum rtw_locale *locale,
681     const char *dvname)
682 {
683 	int i;
684 	const char *rfname, *paname;
685 	char scratch[sizeof ("unknown 0xXX")];
686 	uint16_t version;
687 	uint8_t mac[IEEE80211_ADDR_LEN];
688 
689 	*flags &= ~(RTW_F_DIGPHY|RTW_F_DFLANTB|RTW_F_ANTDIV);
690 	*rcr &= ~(RTW_RCR_ENCS1 | RTW_RCR_ENCS2);
691 
692 	version = RTW_SR_GET16(sr, RTW_SR_VERSION);
693 	RTW_DPRINTF(RTW_DEBUG_IOSTATE, "%s: SROM version %d.%d", dvname,
694 	    version >> 8, version & 0xff);
695 
696 	if (version <= 0x0101) {
697 		cmn_err(CE_NOTE, " is not understood, limping along "
698 		    "with defaults\n");
699 		rtw_srom_defaults(sr, flags, cs_threshold, rfchipid, rcr);
700 		return (0);
701 	}
702 
703 	for (i = 0; i < IEEE80211_ADDR_LEN; i++)
704 		mac[i] = RTW_SR_GET(sr, RTW_SR_MAC + i);
705 
706 	RTW_DPRINTF(RTW_DEBUG_ATTACH,
707 	    "%s: EEPROM MAC %s\n", dvname, mac);
708 
709 	*cs_threshold = RTW_SR_GET(sr, RTW_SR_ENERGYDETTHR);
710 
711 	if ((RTW_SR_GET(sr, RTW_SR_CONFIG2) & RTW_CONFIG2_ANT) != 0)
712 		*flags |= RTW_F_ANTDIV;
713 
714 	/*
715 	 * Note well: the sense of the RTW_SR_RFPARM_DIGPHY bit seems
716 	 * to be reversed.
717 	 */
718 	if ((RTW_SR_GET(sr, RTW_SR_RFPARM) & RTW_SR_RFPARM_DIGPHY) == 0)
719 		*flags |= RTW_F_DIGPHY;
720 	if ((RTW_SR_GET(sr, RTW_SR_RFPARM) & RTW_SR_RFPARM_DFLANTB) != 0)
721 		*flags |= RTW_F_DFLANTB;
722 
723 	*rcr |= LSHIFT(MASK_AND_RSHIFT(RTW_SR_GET(sr, RTW_SR_RFPARM),
724 	    RTW_SR_RFPARM_CS_MASK), RTW_RCR_ENCS1);
725 
726 	*rfchipid = RTW_SR_GET(sr, RTW_SR_RFCHIPID);
727 	switch (*rfchipid) {
728 	case RTW_RFCHIPID_GCT:		/* this combo seen in the wild */
729 		rfname = "GCT GRF5101";
730 		paname = "Winspring WS9901";
731 		break;
732 	case RTW_RFCHIPID_MAXIM:
733 		rfname = "Maxim MAX2820";	/* guess */
734 		paname = "Maxim MAX2422";	/* guess */
735 		break;
736 	case RTW_RFCHIPID_INTERSIL:
737 		rfname = "Intersil HFA3873";	/* guess */
738 		paname = "Intersil <unknown>";
739 		break;
740 	case RTW_RFCHIPID_PHILIPS:	/* this combo seen in the wild */
741 		rfname = "Philips SA2400A";
742 		paname = "Philips SA2411";
743 		break;
744 	case RTW_RFCHIPID_RFMD:
745 		/*
746 		 * this is the same front-end as an atw(4)!
747 		 */
748 		rfname = "RFMD RF2948B, "	/* mentioned in Realtek docs */
749 		    "LNA: RFMD RF2494, "	/* mentioned in Realtek docs */
750 		    "SYN: Silicon Labs Si4126";
751 		paname = "RFMD RF2189";		/* mentioned in Realtek docs */
752 		break;
753 	case RTW_RFCHIPID_RESERVED:
754 		rfname = paname = "reserved";
755 		break;
756 	default:
757 		(void) snprintf(scratch, sizeof (scratch),
758 		    "unknown 0x%02x", *rfchipid);
759 		rfname = paname = scratch;
760 	}
761 	RTW_DPRINTF(RTW_DEBUG_PHY, "%s: RF: %s, PA: %s\n",
762 	    dvname, rfname, paname);
763 
764 	switch (RTW_SR_GET(sr, RTW_SR_CONFIG0) & RTW_CONFIG0_GL_MASK) {
765 	case RTW_CONFIG0_GL_USA:
766 		*locale = RTW_LOCALE_USA;
767 		break;
768 	case RTW_CONFIG0_GL_EUROPE:
769 		*locale = RTW_LOCALE_EUROPE;
770 		break;
771 	case RTW_CONFIG0_GL_JAPAN:
772 		*locale = RTW_LOCALE_JAPAN;
773 		break;
774 	default:
775 		*locale = RTW_LOCALE_UNKNOWN;
776 		break;
777 	}
778 	return (0);
779 }
780 
781 /*
782  * Returns -1 on failure.
783  */
784 static int
785 rtw_srom_read(struct rtw_regs *regs, uint32_t flags, struct rtw_srom *sr,
786     const char *dvname)
787 {
788 	int rc;
789 	struct seeprom_descriptor sd;
790 	uint8_t ecr;
791 
792 	(void) memset(&sd, 0, sizeof (sd));
793 
794 	ecr = RTW_READ8(regs, RTW_9346CR);
795 
796 	if ((flags & RTW_F_9356SROM) != 0) {
797 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "%s: 93c56 SROM\n", dvname);
798 		sr->sr_size = 256;
799 		sd.sd_chip = C56_66;
800 	} else {
801 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "%s: 93c46 SROM\n", dvname);
802 		sr->sr_size = 128;
803 		sd.sd_chip = C46;
804 	}
805 
806 	ecr &= ~(RTW_9346CR_EEDI | RTW_9346CR_EEDO | RTW_9346CR_EESK |
807 	    RTW_9346CR_EEM_MASK | RTW_9346CR_EECS);
808 	ecr |= RTW_9346CR_EEM_PROGRAM;
809 
810 	RTW_WRITE8(regs, RTW_9346CR, ecr);
811 
812 	sr->sr_content = kmem_zalloc(sr->sr_size, KM_SLEEP);
813 
814 	if (sr->sr_content == NULL) {
815 		cmn_err(CE_WARN, "%s: unable to allocate SROM buffer\n",
816 		    dvname);
817 		return (ENOMEM);
818 	}
819 
820 	(void) memset(sr->sr_content, 0, sr->sr_size);
821 
822 	/*
823 	 * RTL8180 has a single 8-bit register for controlling the
824 	 * 93cx6 SROM.  There is no "ready" bit. The RTL8180
825 	 * input/output sense is the reverse of read_seeprom's.
826 	 */
827 	sd.sd_handle = regs->r_handle;
828 	sd.sd_base = regs->r_base;
829 	sd.sd_regsize = 1;
830 	sd.sd_control_offset = RTW_9346CR;
831 	sd.sd_status_offset = RTW_9346CR;
832 	sd.sd_dataout_offset = RTW_9346CR;
833 	sd.sd_CK = RTW_9346CR_EESK;
834 	sd.sd_CS = RTW_9346CR_EECS;
835 	sd.sd_DI = RTW_9346CR_EEDO;
836 	sd.sd_DO = RTW_9346CR_EEDI;
837 	/*
838 	 * make read_seeprom enter EEPROM read/write mode
839 	 */
840 	sd.sd_MS = ecr;
841 	sd.sd_RDY = 0;
842 
843 	/*
844 	 * TBD bus barriers
845 	 */
846 	if (!read_seeprom(&sd, sr->sr_content, 0, sr->sr_size/2)) {
847 		cmn_err(CE_WARN, "%s: could not read SROM\n", dvname);
848 		kmem_free(sr->sr_content, sr->sr_size);
849 		sr->sr_content = NULL;
850 		return (-1);	/* XXX */
851 	}
852 
853 	/*
854 	 * end EEPROM read/write mode
855 	 */
856 	RTW_WRITE8(regs, RTW_9346CR,
857 	    (ecr & ~RTW_9346CR_EEM_MASK) | RTW_9346CR_EEM_NORMAL);
858 	RTW_WBRW(regs, RTW_9346CR, RTW_9346CR);
859 
860 	if ((rc = rtw_recall_eeprom(regs, dvname)) != 0)
861 		return (rc);
862 
863 #ifdef SROM_DEBUG
864 	{
865 		int i;
866 		RTW_DPRINTF(RTW_DEBUG_ATTACH,
867 		    "\n%s: serial ROM:\n\t", dvname);
868 		for (i = 0; i < sr->sr_size/2; i++) {
869 			RTW_DPRINTF(RTW_DEBUG_ATTACH,
870 			    "offset-0x%x: %04x", 2*i, sr->sr_content[i]);
871 		}
872 	}
873 #endif /* DEBUG */
874 	return (0);
875 }
876 
877 static void
878 rtw_set_rfprog(struct rtw_regs *regs, enum rtw_rfchipid rfchipid,
879     const char *dvname)
880 {
881 	uint8_t cfg4;
882 	const char *method;
883 
884 	cfg4 = RTW_READ8(regs, RTW_CONFIG4) & ~RTW_CONFIG4_RFTYPE_MASK;
885 
886 	switch (rfchipid) {
887 	default:
888 		cfg4 |= LSHIFT(0, RTW_CONFIG4_RFTYPE_MASK);
889 		method = "fallback";
890 		break;
891 	case RTW_RFCHIPID_INTERSIL:
892 		cfg4 |= RTW_CONFIG4_RFTYPE_INTERSIL;
893 		method = "Intersil";
894 		break;
895 	case RTW_RFCHIPID_PHILIPS:
896 		cfg4 |= RTW_CONFIG4_RFTYPE_PHILIPS;
897 		method = "Philips";
898 		break;
899 	case RTW_RFCHIPID_GCT:	/* XXX a guess */
900 	case RTW_RFCHIPID_RFMD:
901 		cfg4 |= RTW_CONFIG4_RFTYPE_RFMD;
902 		method = "RFMD";
903 		break;
904 	}
905 
906 	RTW_WRITE8(regs, RTW_CONFIG4, cfg4);
907 
908 	RTW_WBR(regs, RTW_CONFIG4, RTW_CONFIG4);
909 
910 	RTW_DPRINTF(RTW_DEBUG_INIT,
911 	    "%s: %s RF programming method, %02x\n", dvname, method,
912 	    RTW_READ8(regs, RTW_CONFIG4));
913 }
914 
915 static void
916 rtw_init_channels(enum rtw_locale locale,
917     struct ieee80211_channel (*chans)[IEEE80211_CHAN_MAX+1],
918     const char *dvname)
919 {
920 	int i;
921 	const char *name = NULL;
922 #define	ADD_CHANNEL(_chans, _chan) {			\
923 	(*_chans)[_chan].ich_flags = IEEE80211_CHAN_2GHZ | IEEE80211_CHAN_CCK;\
924 	(*_chans)[_chan].ich_freq =				\
925 	    ieee80211_ieee2mhz(_chan, (*_chans)[_chan].ich_flags);\
926 }
927 
928 	switch (locale) {
929 	case RTW_LOCALE_USA:	/* 1-11 */
930 		name = "USA";
931 		for (i = 1; i <= 11; i++)
932 			ADD_CHANNEL(chans, i);
933 		break;
934 	case RTW_LOCALE_JAPAN:	/* 1-14 */
935 		name = "Japan";
936 		ADD_CHANNEL(chans, 14);
937 		for (i = 1; i <= 14; i++)
938 			ADD_CHANNEL(chans, i);
939 		break;
940 	case RTW_LOCALE_EUROPE:	/* 1-13 */
941 		name = "Europe";
942 		for (i = 1; i <= 13; i++)
943 			ADD_CHANNEL(chans, i);
944 		break;
945 	default:			/* 10-11 allowed by most countries */
946 		name = "<unknown>";
947 		for (i = 10; i <= 11; i++)
948 			ADD_CHANNEL(chans, i);
949 		break;
950 	}
951 	RTW_DPRINTF(RTW_DEBUG_ATTACH, "%s: Geographic Location %s\n",
952 	    dvname, name);
953 #undef ADD_CHANNEL
954 }
955 
956 static void
957 rtw_set80211props(struct ieee80211com *ic)
958 {
959 	ic->ic_phytype = IEEE80211_T_DS;
960 	ic->ic_opmode = IEEE80211_M_STA;
961 	ic->ic_caps = IEEE80211_C_PMGT | IEEE80211_C_IBSS |
962 	    IEEE80211_C_SHPREAMBLE;
963 	/* IEEE80211_C_HOSTAP | IEEE80211_C_MONITOR | IEEE80211_C_WEP */
964 
965 	ic->ic_sup_rates[IEEE80211_MODE_11B] = rtw_rateset_11b;
966 }
967 
968 /*ARGSUSED*/
969 static void
970 rtw_identify_country(struct rtw_regs *regs, enum rtw_locale *locale,
971     const char *dvname)
972 {
973 	uint8_t cfg0 = RTW_READ8(regs, RTW_CONFIG0);
974 
975 	switch (cfg0 & RTW_CONFIG0_GL_MASK) {
976 	case RTW_CONFIG0_GL_USA:
977 		*locale = RTW_LOCALE_USA;
978 		break;
979 	case RTW_CONFIG0_GL_JAPAN:
980 		*locale = RTW_LOCALE_JAPAN;
981 		break;
982 	case RTW_CONFIG0_GL_EUROPE:
983 		*locale = RTW_LOCALE_EUROPE;
984 		break;
985 	default:
986 		*locale = RTW_LOCALE_UNKNOWN;
987 		break;
988 	}
989 }
990 
991 static int
992 rtw_identify_sta(struct rtw_regs *regs, uint8_t *addr,
993     const char *dvname)
994 {
995 	uint32_t idr0 = RTW_READ(regs, RTW_IDR0),
996 	    idr1 = RTW_READ(regs, RTW_IDR1);
997 
998 	*addr = MASK_AND_RSHIFT(idr0, BITS(0,  7));
999 	*(addr + 1) = MASK_AND_RSHIFT(idr0, BITS(8,  15));
1000 	*(addr + 2) = MASK_AND_RSHIFT(idr0, BITS(16, 23));
1001 	*(addr + 3) = MASK_AND_RSHIFT(idr0, BITS(24, 31));
1002 
1003 	*(addr + 4) = MASK_AND_RSHIFT(idr1, BITS(0,  7));
1004 	*(addr + 5) = MASK_AND_RSHIFT(idr1, BITS(8, 15));
1005 
1006 	RTW_DPRINTF(RTW_DEBUG_ATTACH,
1007 	    "%s: 802.11mac address %x:%x:%x:%x:%x:%x\n", dvname,
1008 	    *addr, *(addr+1), *(addr+2), *(addr+3), *(addr+4), *(addr+5));
1009 
1010 	return (0);
1011 }
1012 
1013 static uint8_t
1014 rtw_chan2txpower(struct rtw_srom *sr, struct ieee80211com *ic,
1015     struct ieee80211_channel *chan)
1016 {
1017 	uint32_t idx = RTW_SR_TXPOWER1 + ieee80211_chan2ieee(ic, chan) - 1;
1018 	return (RTW_SR_GET(sr, idx));
1019 }
1020 
1021 static void
1022 rtw_rxdesc_init(rtw_softc_t *rsc, struct rtw_rxbuf *rbf, int idx, int is_last)
1023 {
1024 	uint32_t ctl = 0;
1025 	uint8_t *buf = (uint8_t *)rbf->bf_dma.mem_va;
1026 
1027 	ASSERT(rbf != NULL);
1028 	rbf->rxdesc->rd_buf = (rbf->bf_dma.cookie.dmac_address);
1029 	bzero(buf, rbf->bf_dma.alength);
1030 	RTW_DMA_SYNC(rbf->bf_dma, DDI_DMA_SYNC_FORDEV);
1031 
1032 	ctl = (rbf->bf_dma.alength & 0xfff) | RTW_RXCTL_OWN;
1033 
1034 	if (is_last)
1035 		ctl |= RTW_RXCTL_EOR;
1036 
1037 	rbf->rxdesc->rd_ctl = (ctl);
1038 	/* sync the mbuf */
1039 
1040 	/* sync the descriptor */
1041 	RTW_DMA_SYNC_DESC(rsc->sc_desc_dma,
1042 	    RTW_DESC_OFFSET(hd_rx, idx),
1043 	    sizeof (struct rtw_rxdesc),
1044 	    DDI_DMA_SYNC_FORDEV);
1045 }
1046 
1047 static void
1048 rtw_idle(struct rtw_regs *regs)
1049 {
1050 	int active;
1051 
1052 	/* request stop DMA; wait for packets to stop transmitting. */
1053 
1054 	RTW_WRITE8(regs, RTW_TPPOLL, RTW_TPPOLL_SALL);
1055 
1056 	for (active = 0; active < 300 &&
1057 	    (RTW_READ8(regs, RTW_TPPOLL) & RTW_TPPOLL_ALL) != 0; active++)
1058 		drv_usecwait(10);
1059 }
1060 
1061 static void
1062 rtw_io_enable(rtw_softc_t *rsc, uint8_t flags, int enable)
1063 {
1064 	uint8_t cr;
1065 	struct rtw_regs *regs = &rsc->sc_regs;
1066 
1067 	RTW_DPRINTF(RTW_DEBUG_IOSTATE, "%s: %s 0x%02x\n", __func__,
1068 	    enable ? "enable" : "disable", flags);
1069 
1070 	cr = RTW_READ8(regs, RTW_CR);
1071 
1072 	/* The receive engine will always start at RDSAR.  */
1073 	if (enable && (flags & ~cr & RTW_CR_RE)) {
1074 		RTW_DMA_SYNC_DESC(rsc->sc_desc_dma,
1075 		    RTW_DESC_OFFSET(hd_rx, 0),
1076 		    sizeof (struct rtw_rxdesc),
1077 		    DDI_DMA_SYNC_FORCPU);
1078 		rsc->rx_next = 0;
1079 		rtw_rxdesc_init(rsc, rsc->rxbuf_h, 0, 0);
1080 	}
1081 
1082 	if (enable)
1083 		cr |= flags;
1084 	else
1085 		cr &= ~flags;
1086 	RTW_WRITE8(regs, RTW_CR, cr);
1087 	(void) RTW_READ8(regs, RTW_CR);
1088 }
1089 
1090 /*
1091  * Allocate an area of memory and a DMA handle for accessing it
1092  */
1093 static int
1094 rtw_alloc_dma_mem(dev_info_t *devinfo, ddi_dma_attr_t *dma_attr,
1095 	size_t memsize, ddi_device_acc_attr_t *attr_p, uint_t alloc_flags,
1096 	uint_t bind_flags, dma_area_t *dma_p)
1097 {
1098 	int err;
1099 
1100 	/*
1101 	 * Allocate handle
1102 	 */
1103 	err = ddi_dma_alloc_handle(devinfo, dma_attr,
1104 	    DDI_DMA_SLEEP, NULL, &dma_p->dma_hdl);
1105 	if (err != DDI_SUCCESS)
1106 		return (DDI_FAILURE);
1107 
1108 	/*
1109 	 * Allocate memory
1110 	 */
1111 	err = ddi_dma_mem_alloc(dma_p->dma_hdl, memsize, attr_p,
1112 	    alloc_flags, DDI_DMA_SLEEP, NULL, &dma_p->mem_va,
1113 	    &dma_p->alength, &dma_p->acc_hdl);
1114 	if (err != DDI_SUCCESS)
1115 		return (DDI_FAILURE);
1116 
1117 	/*
1118 	 * Bind the two together
1119 	 */
1120 	err = ddi_dma_addr_bind_handle(dma_p->dma_hdl, NULL,
1121 	    dma_p->mem_va, dma_p->alength, bind_flags,
1122 	    DDI_DMA_SLEEP, NULL, &dma_p->cookie, &dma_p->ncookies);
1123 	if ((dma_p->ncookies != 1) || (err != DDI_DMA_MAPPED))
1124 		return (DDI_FAILURE);
1125 
1126 	dma_p->nslots = ~0U;
1127 	dma_p->size = ~0U;
1128 	dma_p->token = ~0U;
1129 	dma_p->offset = 0;
1130 	return (DDI_SUCCESS);
1131 }
1132 
1133 /*
1134  * Free one allocated area of DMAable memory
1135  */
1136 static void
1137 rtw_free_dma_mem(dma_area_t *dma_p)
1138 {
1139 	if (dma_p->dma_hdl != NULL) {
1140 		(void) ddi_dma_unbind_handle(dma_p->dma_hdl);
1141 		if (dma_p->acc_hdl != NULL) {
1142 			ddi_dma_mem_free(&dma_p->acc_hdl);
1143 			dma_p->acc_hdl = NULL;
1144 		}
1145 		ddi_dma_free_handle(&dma_p->dma_hdl);
1146 		dma_p->ncookies = 0;
1147 		dma_p->dma_hdl = NULL;
1148 	}
1149 }
1150 
1151 static void
1152 rtw_dma_free(rtw_softc_t *rsc)
1153 {
1154 	struct rtw_txbuf *txbf;
1155 	struct rtw_rxbuf *rxbf;
1156 	int i, j;
1157 
1158 	/* Free TX DMA buffer */
1159 	for (i = 0; i < RTW_NTXPRI; i++) {
1160 		txbf = list_head(&rsc->sc_txq[i].tx_free_list);
1161 		while (txbf != NULL) {
1162 			rtw_free_dma_mem(&txbf->bf_dma);
1163 			list_remove(&rsc->sc_txq[i].tx_free_list, txbf);
1164 			txbf = list_head(&rsc->sc_txq[i].tx_free_list);
1165 		}
1166 		list_destroy(&rsc->sc_txq[i].tx_free_list);
1167 		txbf = list_head(&rsc->sc_txq[i].tx_dirty_list);
1168 		while (txbf != NULL) {
1169 			rtw_free_dma_mem(&txbf->bf_dma);
1170 			list_remove(&rsc->sc_txq[i].tx_dirty_list, txbf);
1171 			txbf = list_head(&rsc->sc_txq[i].tx_dirty_list);
1172 		}
1173 		list_destroy(&rsc->sc_txq[i].tx_dirty_list);
1174 
1175 		if (rsc->sc_txq[i].txbuf_h != NULL) {
1176 			kmem_free(rsc->sc_txq[i].txbuf_h,
1177 			    sizeof (struct rtw_txbuf) * rtw_qlen[i]);
1178 			rsc->sc_txq[i].txbuf_h = NULL;
1179 		}
1180 	}
1181 
1182 	/* Free RX DMA buffer */
1183 	rxbf = rsc->rxbuf_h;
1184 	for (j = 0; j < RTW_RXQLEN; j++) {
1185 		rtw_free_dma_mem(&rxbf->bf_dma);
1186 		rxbf++;
1187 	}
1188 
1189 	if (rsc->rxbuf_h != NULL) {
1190 		kmem_free(rsc->rxbuf_h,
1191 		    sizeof (struct rtw_rxbuf) * RTW_RXQLEN);
1192 		rsc->rxbuf_h = NULL;
1193 	}
1194 
1195 	rtw_free_dma_mem(&rsc->sc_desc_dma);
1196 }
1197 
1198 static int
1199 rtw_dma_init(dev_info_t *devinfo, rtw_softc_t *rsc)
1200 {
1201 	int i, j, err;
1202 	size_t size;
1203 	uint32_t buflen;
1204 	struct rtw_txdesc *txds;
1205 	struct rtw_rxdesc *rxds;
1206 	struct rtw_txbuf *txbf;
1207 	struct rtw_rxbuf *rxbf;
1208 	uint32_t phybaseaddr, ptx[RTW_NTXPRI], prx;
1209 	caddr_t virbaseaddr, vtx[RTW_NTXPRI], vrx;
1210 
1211 	/* DMA buffer size for each TX/RX packet */
1212 	rsc->sc_dmabuf_size = roundup(sizeof (struct ieee80211_frame) + 0x100 +
1213 	    IEEE80211_MTU + IEEE80211_CRC_LEN + sizeof (struct ieee80211_llc) +
1214 	    (IEEE80211_WEP_IVLEN + IEEE80211_WEP_KIDLEN +
1215 	    IEEE80211_WEP_CRCLEN), rsc->sc_cachelsz);
1216 	size = sizeof (struct rtw_descs);
1217 	err = rtw_alloc_dma_mem(devinfo, &dma_attr_desc, size,
1218 	    &rtw_desc_accattr,
1219 	    DDI_DMA_CONSISTENT, DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
1220 	    &rsc->sc_desc_dma);
1221 	if (err != DDI_SUCCESS)
1222 		goto error;
1223 	phybaseaddr = rsc->sc_desc_dma.cookie.dmac_address;
1224 	virbaseaddr = rsc->sc_desc_dma.mem_va;
1225 	ptx[0] = RTW_RING_BASE(phybaseaddr, hd_txlo);
1226 	ptx[1] = RTW_RING_BASE(phybaseaddr, hd_txmd);
1227 	ptx[2] = RTW_RING_BASE(phybaseaddr, hd_txhi);
1228 	ptx[3] = RTW_RING_BASE(phybaseaddr, hd_bcn);
1229 	vtx[0] = (caddr_t)(RTW_RING_BASE(virbaseaddr, hd_txlo));
1230 	vtx[1] = (caddr_t)(RTW_RING_BASE(virbaseaddr, hd_txmd));
1231 	vtx[2] = (caddr_t)(RTW_RING_BASE(virbaseaddr, hd_txhi));
1232 	vtx[3] = (caddr_t)(RTW_RING_BASE(virbaseaddr, hd_bcn));
1233 	for (i = 0; i < RTW_NTXPRI; i++) {
1234 		RTW_DPRINTF(RTW_DEBUG_DMA, "p[%d]=%x, v[%d]=%x", i, ptx[i],
1235 		    i, vtx[i]);
1236 		RTW_DPRINTF(RTW_DEBUG_DMA, "ring%d:", i);
1237 		list_create(&rsc->sc_txq[i].tx_free_list,
1238 		    sizeof (struct rtw_txbuf),
1239 		    offsetof(struct rtw_txbuf, bf_node));
1240 		list_create(&rsc->sc_txq[i].tx_dirty_list,
1241 		    sizeof (struct rtw_txbuf),
1242 		    offsetof(struct rtw_txbuf, bf_node));
1243 		/* virtual address of the first descriptor */
1244 		rsc->sc_txq[i].txdesc_h =
1245 		    (struct rtw_txdesc *)(uintptr_t)vtx[i];
1246 
1247 		txds = rsc->sc_txq[i].txdesc_h;
1248 		/* allocate data structures to describe TX DMA buffers */
1249 		buflen = sizeof (struct rtw_txbuf) * rtw_qlen[i];
1250 		txbf = (struct rtw_txbuf *)kmem_zalloc(buflen, KM_SLEEP);
1251 		rsc->sc_txq[i].txbuf_h = txbf;
1252 		for (j = 0; j < rtw_qlen[i]; j++, txbf++, txds++) {
1253 			txbf->txdesc = txds;
1254 			txbf->bf_daddr = ptx[i] + ((uintptr_t)txds -
1255 			    (uintptr_t)rsc->sc_txq[i].txdesc_h);
1256 			list_insert_tail(&rsc->sc_txq[i].tx_free_list, txbf);
1257 
1258 			/* alloc DMA memory */
1259 			err = rtw_alloc_dma_mem(devinfo, &dma_attr_txbuf,
1260 			    rsc->sc_dmabuf_size,
1261 			    &rtw_buf_accattr,
1262 			    DDI_DMA_STREAMING,
1263 			    DDI_DMA_WRITE | DDI_DMA_STREAMING,
1264 			    &txbf->bf_dma);
1265 			if (err != DDI_SUCCESS)
1266 				goto error;
1267 			RTW_DPRINTF(RTW_DEBUG_DMA, "pbufaddr[%d]=%x",
1268 			    j, txbf->bf_dma.cookie.dmac_address);
1269 		}
1270 	}
1271 	prx = RTW_RING_BASE(phybaseaddr, hd_rx);
1272 	vrx = (caddr_t)(RTW_RING_BASE(virbaseaddr, hd_rx));
1273 	/* virtual address of the first descriptor */
1274 	rsc->rxdesc_h = (struct rtw_rxdesc *)(uintptr_t)vrx;
1275 	rxds = rsc->rxdesc_h;
1276 
1277 	/* allocate data structures to describe RX DMA buffers */
1278 	buflen = sizeof (struct rtw_rxbuf) * RTW_RXQLEN;
1279 	rxbf = (struct rtw_rxbuf *)kmem_zalloc(buflen, KM_SLEEP);
1280 	rsc->rxbuf_h = rxbf;
1281 
1282 	for (j = 0; j < RTW_RXQLEN; j++, rxbf++, rxds++) {
1283 		rxbf->rxdesc = rxds;
1284 		rxbf->bf_daddr =
1285 		    prx + ((uintptr_t)rxds - (uintptr_t)rsc->rxdesc_h);
1286 
1287 		/* alloc DMA memory */
1288 		err = rtw_alloc_dma_mem(devinfo, &dma_attr_rxbuf,
1289 		    rsc->sc_dmabuf_size,
1290 		    &rtw_buf_accattr,
1291 		    DDI_DMA_STREAMING, DDI_DMA_READ | DDI_DMA_STREAMING,
1292 		    &rxbf->bf_dma);
1293 		if (err != DDI_SUCCESS)
1294 			goto error;
1295 	}
1296 
1297 	return (DDI_SUCCESS);
1298 error:
1299 	return (DDI_FAILURE);
1300 }
1301 
1302 static void
1303 rtw_hwring_setup(rtw_softc_t *rsc)
1304 {
1305 	struct rtw_regs *regs = &rsc->sc_regs;
1306 	uint32_t phybaseaddr;
1307 
1308 	phybaseaddr = rsc->sc_desc_dma.cookie.dmac_address;
1309 
1310 	RTW_WRITE(regs, RTW_RDSAR, RTW_RING_BASE(phybaseaddr, hd_rx));
1311 	RTW_WRITE(regs, RTW_TLPDA, RTW_RING_BASE(phybaseaddr, hd_txlo));
1312 	RTW_WRITE(regs, RTW_TNPDA, RTW_RING_BASE(phybaseaddr, hd_txmd));
1313 	RTW_WRITE(regs, RTW_THPDA, RTW_RING_BASE(phybaseaddr, hd_txhi));
1314 	RTW_WRITE(regs, RTW_TBDA, RTW_RING_BASE(phybaseaddr, hd_bcn));
1315 	rsc->hw_start = RTW_READ(regs, RTW_TNPDA);
1316 	rsc->hw_go = RTW_READ(regs, RTW_TNPDA);
1317 }
1318 
1319 static void
1320 rtw_swring_setup(rtw_softc_t *rsc, int flag)
1321 {
1322 	int i, j;
1323 	int is_last;
1324 	struct rtw_txbuf *txbf;
1325 	struct rtw_rxbuf *rxbf;
1326 	uint32_t phybaseaddr, ptx[RTW_NTXPRI], baddr_desc, taddr_desc;
1327 
1328 	phybaseaddr = rsc->sc_desc_dma.cookie.dmac_address;
1329 	ptx[0] = RTW_RING_BASE(phybaseaddr, hd_txlo);
1330 	ptx[1] = RTW_RING_BASE(phybaseaddr, hd_txmd);
1331 	ptx[2] = RTW_RING_BASE(phybaseaddr, hd_txhi);
1332 	ptx[3] = RTW_RING_BASE(phybaseaddr, hd_bcn);
1333 	RTW_DMA_SYNC(rsc->sc_desc_dma, DDI_DMA_SYNC_FORDEV);
1334 	/* sync tx desc and tx buf */
1335 	for (i = 0; i < RTW_NTXPRI; i++) {
1336 		rsc->sc_txq[i].tx_prod = rsc->sc_txq[i].tx_cons = 0;
1337 		rsc->sc_txq[i].tx_nfree = rtw_qlen[i];
1338 		txbf = list_head(&rsc->sc_txq[i].tx_free_list);
1339 		while (txbf != NULL) {
1340 			list_remove(&rsc->sc_txq[i].tx_free_list, txbf);
1341 			txbf = list_head(&rsc->sc_txq[i].tx_free_list);
1342 		}
1343 		txbf = list_head(&rsc->sc_txq[i].tx_dirty_list);
1344 		while (txbf != NULL) {
1345 			list_remove(&rsc->sc_txq[i].tx_dirty_list, txbf);
1346 			txbf = list_head(&rsc->sc_txq[i].tx_dirty_list);
1347 		}
1348 		txbf = rsc->sc_txq[i].txbuf_h;
1349 		baddr_desc = ptx[i];
1350 		taddr_desc = baddr_desc + sizeof (struct rtw_txdesc);
1351 		for (j = 0; j < rtw_qlen[i]; j++) {
1352 			list_insert_tail(&rsc->sc_txq[i].tx_free_list, txbf);
1353 			if (j == (rtw_qlen[i] - 1)) {
1354 				is_last = 1;
1355 			} else {
1356 				is_last = 0;
1357 			}
1358 
1359 			if (is_last) {
1360 				txbf->txdesc->td_next = baddr_desc;
1361 			} else {
1362 				txbf->txdesc->td_next = taddr_desc;
1363 			}
1364 			txbf->next_bf_daddr = txbf->txdesc->td_next;
1365 			RTW_DMA_SYNC(txbf->bf_dma, DDI_DMA_SYNC_FORDEV);
1366 			txbf->order = j;
1367 			txbf++;
1368 			taddr_desc += sizeof (struct rtw_txdesc);
1369 		}
1370 	}
1371 	if (!flag)
1372 		return;
1373 
1374 	/* sync rx desc and rx buf */
1375 	rsc->rx_next = 0;
1376 	rxbf = rsc->rxbuf_h;
1377 	for (j = 0; j < RTW_RXQLEN; j++) {
1378 		RTW_DMA_SYNC(rxbf->bf_dma, DDI_DMA_SYNC_FORCPU);
1379 		if (j == (RTW_RXQLEN - 1))
1380 			is_last = 1;
1381 		else
1382 			is_last = 0;
1383 		rtw_rxdesc_init(rsc, rxbf, j, is_last);
1384 		rxbf++;
1385 	}
1386 }
1387 
1388 static void
1389 rtw_resume_ticks(rtw_softc_t *rsc)
1390 {
1391 	RTW_WRITE(&rsc->sc_regs, RTW_TINT, 0xffffffff);
1392 }
1393 
1394 const char *
1395 rtw_pwrstate_string(enum rtw_pwrstate power)
1396 {
1397 	switch (power) {
1398 	case RTW_ON:
1399 		return ("on");
1400 	case RTW_SLEEP:
1401 		return ("sleep");
1402 	case RTW_OFF:
1403 		return ("off");
1404 	default:
1405 		return ("unknown");
1406 	}
1407 }
1408 
1409 /*
1410  * XXX For Maxim, I am using the RFMD settings gleaned from the
1411  * reference driver, plus a magic Maxim "ON" value that comes from
1412  * the Realtek document "Windows PG for Rtl8180."
1413  */
1414 /*ARGSUSED*/
1415 static void
1416 rtw_maxim_pwrstate(struct rtw_regs *regs, enum rtw_pwrstate power,
1417     int before_rf, int digphy)
1418 {
1419 	uint32_t anaparm;
1420 
1421 	anaparm = RTW_READ(regs, RTW_ANAPARM);
1422 	anaparm &= ~(RTW_ANAPARM_RFPOW_MASK | RTW_ANAPARM_TXDACOFF);
1423 
1424 	switch (power) {
1425 	case RTW_OFF:
1426 		if (before_rf)
1427 			return;
1428 		anaparm |= RTW_ANAPARM_RFPOW_MAXIM_OFF;
1429 		anaparm |= RTW_ANAPARM_TXDACOFF;
1430 		break;
1431 	case RTW_SLEEP:
1432 		if (!before_rf)
1433 			return;
1434 		anaparm |= RTW_ANAPARM_RFPOW_MAXIM_SLEEP;
1435 		anaparm |= RTW_ANAPARM_TXDACOFF;
1436 		break;
1437 	case RTW_ON:
1438 		if (!before_rf)
1439 			return;
1440 		anaparm |= RTW_ANAPARM_RFPOW_MAXIM_ON;
1441 		break;
1442 	}
1443 	RTW_DPRINTF(RTW_DEBUG_PWR,
1444 	    "%s: power state %s, %s RF, reg[ANAPARM] <- %08x\n",
1445 	    __func__, rtw_pwrstate_string(power),
1446 	    (before_rf) ? "before" : "after", anaparm);
1447 
1448 	RTW_WRITE(regs, RTW_ANAPARM, anaparm);
1449 	RTW_SYNC(regs, RTW_ANAPARM, RTW_ANAPARM);
1450 }
1451 
1452 /*
1453  * XXX I am using the RFMD settings gleaned from the reference
1454  * driver.  They agree
1455  */
1456 /*ARGSUSED*/
1457 static void
1458 rtw_rfmd_pwrstate(struct rtw_regs *regs, enum rtw_pwrstate power,
1459     int before_rf, int digphy)
1460 {
1461 	uint32_t anaparm;
1462 
1463 	anaparm = RTW_READ(regs, RTW_ANAPARM);
1464 	anaparm &= ~(RTW_ANAPARM_RFPOW_MASK | RTW_ANAPARM_TXDACOFF);
1465 
1466 	switch (power) {
1467 	case RTW_OFF:
1468 		if (before_rf)
1469 			return;
1470 		anaparm |= RTW_ANAPARM_RFPOW_RFMD_OFF;
1471 		anaparm |= RTW_ANAPARM_TXDACOFF;
1472 		break;
1473 	case RTW_SLEEP:
1474 		if (!before_rf)
1475 			return;
1476 		anaparm |= RTW_ANAPARM_RFPOW_RFMD_SLEEP;
1477 		anaparm |= RTW_ANAPARM_TXDACOFF;
1478 		break;
1479 	case RTW_ON:
1480 		if (!before_rf)
1481 			return;
1482 		anaparm |= RTW_ANAPARM_RFPOW_RFMD_ON;
1483 		break;
1484 	}
1485 	RTW_DPRINTF(RTW_DEBUG_PWR,
1486 	    "%s: power state %s, %s RF, reg[ANAPARM] <- %08x\n",
1487 	    __func__, rtw_pwrstate_string(power),
1488 	    (before_rf) ? "before" : "after", anaparm);
1489 
1490 	RTW_WRITE(regs, RTW_ANAPARM, anaparm);
1491 	RTW_SYNC(regs, RTW_ANAPARM, RTW_ANAPARM);
1492 }
1493 
1494 static void
1495 rtw_philips_pwrstate(struct rtw_regs *regs, enum rtw_pwrstate power,
1496     int before_rf, int digphy)
1497 {
1498 	uint32_t anaparm;
1499 
1500 	anaparm = RTW_READ(regs, RTW_ANAPARM);
1501 	anaparm &= ~(RTW_ANAPARM_RFPOW_MASK | RTW_ANAPARM_TXDACOFF);
1502 
1503 	switch (power) {
1504 	case RTW_OFF:
1505 		if (before_rf)
1506 			return;
1507 		anaparm |= RTW_ANAPARM_RFPOW_PHILIPS_OFF;
1508 		anaparm |= RTW_ANAPARM_TXDACOFF;
1509 		break;
1510 	case RTW_SLEEP:
1511 		if (!before_rf)
1512 			return;
1513 		anaparm |= RTW_ANAPARM_RFPOW_PHILIPS_SLEEP;
1514 		anaparm |= RTW_ANAPARM_TXDACOFF;
1515 		break;
1516 	case RTW_ON:
1517 		if (!before_rf)
1518 			return;
1519 		if (digphy) {
1520 			anaparm |= RTW_ANAPARM_RFPOW_DIG_PHILIPS_ON;
1521 			/* XXX guess */
1522 			anaparm |= RTW_ANAPARM_TXDACOFF;
1523 		} else
1524 			anaparm |= RTW_ANAPARM_RFPOW_ANA_PHILIPS_ON;
1525 		break;
1526 	}
1527 	RTW_DPRINTF(RTW_DEBUG_PWR,
1528 	    "%s: power state %s, %s RF, reg[ANAPARM] <- %08x\n",
1529 	    __func__, rtw_pwrstate_string(power),
1530 	    (before_rf) ? "before" : "after", anaparm);
1531 
1532 	RTW_WRITE(regs, RTW_ANAPARM, anaparm);
1533 	RTW_SYNC(regs, RTW_ANAPARM, RTW_ANAPARM);
1534 }
1535 
1536 static void
1537 rtw_pwrstate0(rtw_softc_t *rsc, enum rtw_pwrstate power, int before_rf,
1538     int digphy)
1539 {
1540 	struct rtw_regs *regs = &rsc->sc_regs;
1541 
1542 	rtw_set_access(regs, RTW_ACCESS_ANAPARM);
1543 
1544 	(*rsc->sc_pwrstate_cb)(regs, power, before_rf, digphy);
1545 
1546 	rtw_set_access(regs, RTW_ACCESS_NONE);
1547 }
1548 
1549 static void
1550 rtw_rf_destroy(struct rtw_rf *rf)
1551 {
1552 	(*rf->rf_destroy)(rf);
1553 }
1554 
1555 static int
1556 rtw_rf_pwrstate(struct rtw_rf *rf, enum rtw_pwrstate power)
1557 {
1558 	return (*rf->rf_pwrstate)(rf, power);
1559 }
1560 
1561 static int
1562 rtw_pwrstate(rtw_softc_t *rsc, enum rtw_pwrstate power)
1563 {
1564 	int rc;
1565 
1566 	RTW_DPRINTF(RTW_DEBUG_PWR,
1567 	    "%s: %s->%s\n", __func__,
1568 	    rtw_pwrstate_string(rsc->sc_pwrstate), rtw_pwrstate_string(power));
1569 
1570 	if (rsc->sc_pwrstate == power)
1571 		return (0);
1572 
1573 	rtw_pwrstate0(rsc, power, 1, rsc->sc_flags & RTW_F_DIGPHY);
1574 	rc = rtw_rf_pwrstate(rsc->sc_rf, power);
1575 	rtw_pwrstate0(rsc, power, 0, rsc->sc_flags & RTW_F_DIGPHY);
1576 
1577 	switch (power) {
1578 	case RTW_ON:
1579 		/* TBD set LEDs */
1580 		break;
1581 	case RTW_SLEEP:
1582 		/* TBD */
1583 		break;
1584 	case RTW_OFF:
1585 		/* TBD */
1586 		break;
1587 	}
1588 	if (rc == 0)
1589 		rsc->sc_pwrstate = power;
1590 	else
1591 		rsc->sc_pwrstate = RTW_OFF;
1592 	return (rc);
1593 }
1594 
1595 void
1596 rtw_disable(rtw_softc_t *rsc)
1597 {
1598 	int rc;
1599 
1600 	if ((rsc->sc_flags & RTW_F_ENABLED) == 0)
1601 		return;
1602 
1603 	/* turn off PHY */
1604 	if ((rsc->sc_flags & RTW_F_INVALID) == 0 &&
1605 	    (rc = rtw_pwrstate(rsc, RTW_OFF)) != 0) {
1606 		cmn_err(CE_WARN, "failed to turn off PHY (%d)\n", rc);
1607 	}
1608 
1609 	if (rsc->sc_disable != NULL)
1610 		(*rsc->sc_disable)(rsc);
1611 
1612 	rsc->sc_flags &= ~RTW_F_ENABLED;
1613 }
1614 
1615 int
1616 rtw_enable(rtw_softc_t *rsc)
1617 {
1618 	if ((rsc->sc_flags & RTW_F_ENABLED) == 0) {
1619 		if (rsc->sc_enable != NULL && (*rsc->sc_enable)(rsc) != 0) {
1620 			cmn_err(CE_WARN, "device enable failed\n");
1621 			return (EIO);
1622 		}
1623 		rsc->sc_flags |= RTW_F_ENABLED;
1624 		if (rtw_pwrstate(rsc, RTW_ON) != 0)
1625 			cmn_err(CE_WARN, "PHY turn on failed\n");
1626 	}
1627 	return (0);
1628 }
1629 
1630 static void
1631 rtw_set_nettype(rtw_softc_t *rsc, enum ieee80211_opmode opmode)
1632 {
1633 	uint8_t msr;
1634 
1635 	/* I'm guessing that MSR is protected as CONFIG[0123] are. */
1636 	rtw_set_access(&rsc->sc_regs, RTW_ACCESS_CONFIG);
1637 
1638 	msr = RTW_READ8(&rsc->sc_regs, RTW_MSR) & ~RTW_MSR_NETYPE_MASK;
1639 
1640 	switch (opmode) {
1641 	case IEEE80211_M_AHDEMO:
1642 	case IEEE80211_M_IBSS:
1643 		msr |= RTW_MSR_NETYPE_ADHOC_OK;
1644 		break;
1645 	case IEEE80211_M_HOSTAP:
1646 		msr |= RTW_MSR_NETYPE_AP_OK;
1647 		break;
1648 	case IEEE80211_M_STA:
1649 		msr |= RTW_MSR_NETYPE_INFRA_OK;
1650 		break;
1651 	}
1652 	RTW_WRITE8(&rsc->sc_regs, RTW_MSR, msr);
1653 
1654 	rtw_set_access(&rsc->sc_regs, RTW_ACCESS_NONE);
1655 }
1656 
1657 static void
1658 rtw_pktfilt_load(rtw_softc_t *rsc)
1659 {
1660 	struct rtw_regs *regs = &rsc->sc_regs;
1661 	struct ieee80211com *ic = &rsc->sc_ic;
1662 
1663 	/* XXX might be necessary to stop Rx/Tx engines while setting filters */
1664 	rsc->sc_rcr &= ~RTW_RCR_PKTFILTER_MASK;
1665 	rsc->sc_rcr &= ~(RTW_RCR_MXDMA_MASK | RTW_RCR_RXFTH_MASK);
1666 
1667 	rsc->sc_rcr |= RTW_RCR_PKTFILTER_DEFAULT;
1668 	/* MAC auto-reset PHY (huh?) */
1669 	rsc->sc_rcr |= RTW_RCR_ENMARP;
1670 	/* DMA whole Rx packets, only.  Set Tx DMA burst size to 1024 bytes. */
1671 	rsc->sc_rcr |= RTW_RCR_RXFTH_WHOLE |RTW_RCR_MXDMA_1024;
1672 
1673 	switch (ic->ic_opmode) {
1674 	case IEEE80211_M_AHDEMO:
1675 	case IEEE80211_M_IBSS:
1676 		/* receive broadcasts in our BSS */
1677 		rsc->sc_rcr |= RTW_RCR_ADD3;
1678 		break;
1679 	default:
1680 		break;
1681 	}
1682 #if 0
1683 	/* XXX accept all broadcast if scanning */
1684 	rsc->sc_rcr |= RTW_RCR_AB;	/* accept all broadcast */
1685 #endif
1686 	RTW_WRITE(regs, RTW_MAR0, 0xffffffff);
1687 	RTW_WRITE(regs, RTW_MAR1, 0xffffffff);
1688 	rsc->sc_rcr |= RTW_RCR_AM;
1689 	RTW_WRITE(regs, RTW_RCR, rsc->sc_rcr);
1690 	RTW_SYNC(regs, RTW_MAR0, RTW_RCR); /* RTW_MAR0 < RTW_MAR1 < RTW_RCR */
1691 
1692 	RTW_DPRINTF(RTW_DEBUG_PKTFILT,
1693 	    "RTW_MAR0 %08x RTW_MAR1 %08x RTW_RCR %08x\n",
1694 	    RTW_READ(regs, RTW_MAR0),
1695 	    RTW_READ(regs, RTW_MAR1), RTW_READ(regs, RTW_RCR));
1696 	RTW_WRITE(regs, RTW_RCR, rsc->sc_rcr);
1697 }
1698 
1699 static void
1700 rtw_transmit_config(struct rtw_regs *regs)
1701 {
1702 	uint32_t tcr;
1703 
1704 	tcr = RTW_READ(regs, RTW_TCR);
1705 
1706 	tcr |= RTW_TCR_CWMIN;
1707 	tcr &= ~RTW_TCR_MXDMA_MASK;
1708 	tcr |= RTW_TCR_MXDMA_1024;
1709 	tcr |= RTW_TCR_SAT;		/* send ACK as fast as possible */
1710 	tcr &= ~RTW_TCR_LBK_MASK;
1711 	tcr |= RTW_TCR_LBK_NORMAL;	/* normal operating mode */
1712 
1713 	/* set short/long retry limits */
1714 	tcr &= ~(RTW_TCR_SRL_MASK|RTW_TCR_LRL_MASK);
1715 	tcr |= LSHIFT(0x4, RTW_TCR_SRL_MASK) | LSHIFT(0x4, RTW_TCR_LRL_MASK);
1716 
1717 	tcr &= ~RTW_TCR_CRC;	/* NIC appends CRC32 */
1718 	RTW_WRITE(regs, RTW_TCR, tcr);
1719 	RTW_SYNC(regs, RTW_TCR, RTW_TCR);
1720 }
1721 
1722 int
1723 rtw_refine_setting(rtw_softc_t *rsc)
1724 {
1725 	struct rtw_regs *regs;
1726 	int rc = 0;
1727 
1728 	regs = &rsc->sc_regs;
1729 	rc = rtw_reset(rsc);
1730 	if (rc != 0)
1731 		return (-1);
1732 
1733 	rtw_beacon_tx_disable(regs);
1734 	rtw_io_enable(rsc, RTW_CR_RE|RTW_CR_TE, 1);
1735 	rtw_set_mode(regs, RTW_EPROM_CMD_CONFIG);
1736 
1737 	rtw_transmit_config(regs);
1738 	rtw_pktfilt_load(rsc);
1739 	rtw_set_access(regs, RTW_ACCESS_CONFIG);
1740 	RTW_WRITE(regs, RTW_TINT, 0xffffffff);
1741 	RTW_WRITE8(regs, RTW_MSR, 0x0);	/* no link */
1742 	RTW_WRITE16(regs, RTW_BRSR, 0);
1743 
1744 	rtw_set_access(regs, RTW_ACCESS_ANAPARM);
1745 	rtw_set_access(regs, RTW_ACCESS_NONE);
1746 	RTW_WRITE(regs, RTW_FEMR, 0xffff);
1747 	RTW_SYNC(regs, RTW_FEMR, RTW_FEMR);
1748 	rtw_set_rfprog(regs, rsc->sc_rfchipid, "rtw");
1749 
1750 	RTW_WRITE8(regs, RTW_PHYDELAY, rsc->sc_phydelay);
1751 	RTW_WRITE8(regs, RTW_CRCOUNT, RTW_CRCOUNT_MAGIC);
1752 	rtw_set_mode(regs, RTW_EPROM_CMD_NORMAL);
1753 	return (0);
1754 }
1755 
1756 static int
1757 rtw_tune(rtw_softc_t *rsc)
1758 {
1759 	struct ieee80211com *ic = &rsc->sc_ic;
1760 	uint32_t chan;
1761 	int rc;
1762 	int antdiv = rsc->sc_flags & RTW_F_ANTDIV,
1763 	    dflantb = rsc->sc_flags & RTW_F_DFLANTB;
1764 
1765 	ASSERT(ic->ic_curchan != NULL);
1766 
1767 	chan = ieee80211_chan2ieee(ic, ic->ic_curchan);
1768 	RTW_DPRINTF(RTW_DEBUG_TUNE, "rtw: chan no = %x", chan);
1769 
1770 	if (chan == IEEE80211_CHAN_ANY) {
1771 		cmn_err(CE_WARN, "%s: chan == IEEE80211_CHAN_ANY\n", __func__);
1772 		return (-1);
1773 	}
1774 
1775 	if (chan == rsc->sc_cur_chan) {
1776 		RTW_DPRINTF(RTW_DEBUG_TUNE,
1777 		    "%s: already tuned chan %d\n", __func__, chan);
1778 		return (0);
1779 	}
1780 	rtw_idle(&rsc->sc_regs);
1781 	rtw_io_enable(rsc, RTW_CR_RE | RTW_CR_TE, 0);
1782 	ASSERT((rsc->sc_flags & RTW_F_ENABLED) != 0);
1783 
1784 	if ((rc = rtw_phy_init(&rsc->sc_regs, rsc->sc_rf,
1785 	    rtw_chan2txpower(&rsc->sc_srom, ic, ic->ic_curchan),
1786 	    rsc->sc_csthr, ic->ic_curchan->ich_freq, antdiv,
1787 	    dflantb, RTW_ON)) != 0) {
1788 		/* XXX condition on powersaving */
1789 		cmn_err(CE_NOTE, "phy init failed\n");
1790 	}
1791 	rtw_io_enable(rsc, RTW_CR_RE | RTW_CR_TE, 1);
1792 	rtw_resume_ticks(rsc);
1793 	rsc->sc_cur_chan = chan;
1794 	return (rc);
1795 }
1796 
1797 static int
1798 rtw_init(rtw_softc_t *rsc)
1799 {
1800 	struct ieee80211com *ic = &rsc->sc_ic;
1801 	int rc = 0;
1802 
1803 	rtw_stop(rsc);
1804 	mutex_enter(&rsc->sc_genlock);
1805 	if ((rc = rtw_enable(rsc)) != 0)
1806 		goto out;
1807 	rc = rtw_refine_setting(rsc);
1808 	if (rc != 0) {
1809 		mutex_exit(&rsc->sc_genlock);
1810 		return (rc);
1811 	}
1812 	rtw_swring_setup(rsc, 1);
1813 	rtw_hwring_setup(rsc);
1814 	RTW_WRITE16(&rsc->sc_regs, RTW_BSSID16, 0x0);
1815 	RTW_WRITE(&rsc->sc_regs, RTW_BSSID32, 0x0);
1816 	rtw_enable_interrupts(rsc);
1817 
1818 	ic->ic_ibss_chan = &ic->ic_sup_channels[1];
1819 	ic->ic_curchan = ic->ic_ibss_chan;
1820 	RTW_DPRINTF(RTW_DEBUG_TUNE, "%s: channel %d freq %d flags 0x%04x\n",
1821 	    __func__, ieee80211_chan2ieee(ic, ic->ic_curchan),
1822 	    ic->ic_curchan->ich_freq, ic->ic_curchan->ich_flags);
1823 	rsc->sc_invalid = 0;
1824 out:
1825 	mutex_exit(&rsc->sc_genlock);
1826 	return (rc);
1827 }
1828 
1829 static struct rtw_rf *
1830 rtw_rf_attach(rtw_softc_t *rsc, enum rtw_rfchipid rfchipid, int digphy)
1831 {
1832 	rtw_rf_write_t rf_write;
1833 	struct rtw_rf *rf;
1834 	int rtw_host_rfio;
1835 
1836 	switch (rfchipid) {
1837 	default:
1838 		rf_write = rtw_rf_hostwrite;
1839 		break;
1840 	case RTW_RFCHIPID_INTERSIL:
1841 	case RTW_RFCHIPID_PHILIPS:
1842 	case RTW_RFCHIPID_GCT:	/* XXX a guess */
1843 	case RTW_RFCHIPID_RFMD:
1844 		rtw_host_rfio = 1;
1845 		rf_write = (rtw_host_rfio) ? rtw_rf_hostwrite : rtw_rf_macwrite;
1846 		break;
1847 	}
1848 
1849 	switch (rfchipid) {
1850 	case RTW_RFCHIPID_MAXIM:
1851 		rf = rtw_max2820_create(&rsc->sc_regs, rf_write, 0);
1852 		rsc->sc_pwrstate_cb = rtw_maxim_pwrstate;
1853 		break;
1854 	case RTW_RFCHIPID_PHILIPS:
1855 		rf = rtw_sa2400_create(&rsc->sc_regs, rf_write, digphy);
1856 		rsc->sc_pwrstate_cb = rtw_philips_pwrstate;
1857 		break;
1858 	case RTW_RFCHIPID_RFMD:
1859 		/* XXX RFMD has no RF constructor */
1860 		rsc->sc_pwrstate_cb = rtw_rfmd_pwrstate;
1861 		/*FALLTHROUGH*/
1862 	default:
1863 		return (NULL);
1864 	}
1865 	if (rf != NULL) {
1866 		rf->rf_continuous_tx_cb =
1867 		    (rtw_continuous_tx_cb_t)rtw_continuous_tx_enable;
1868 		rf->rf_continuous_tx_arg = (void *)rsc;
1869 	}
1870 	return (rf);
1871 }
1872 
1873 /*
1874  * Revision C and later use a different PHY delay setting than
1875  * revisions A and B.
1876  */
1877 static uint8_t
1878 rtw_check_phydelay(struct rtw_regs *regs, uint32_t rcr0)
1879 {
1880 #define	REVAB (RTW_RCR_MXDMA_UNLIMITED | RTW_RCR_AICV)
1881 #define	REVC (REVAB | RTW_RCR_RXFTH_WHOLE)
1882 
1883 	uint8_t phydelay = LSHIFT(0x6, RTW_PHYDELAY_PHYDELAY);
1884 
1885 	RTW_WRITE(regs, RTW_RCR, REVAB);
1886 	RTW_WBW(regs, RTW_RCR, RTW_RCR);
1887 	RTW_WRITE(regs, RTW_RCR, REVC);
1888 
1889 	RTW_WBR(regs, RTW_RCR, RTW_RCR);
1890 	if ((RTW_READ(regs, RTW_RCR) & REVC) == REVC)
1891 		phydelay |= RTW_PHYDELAY_REVC_MAGIC;
1892 
1893 	RTW_WRITE(regs, RTW_RCR, rcr0);	/* restore RCR */
1894 	RTW_SYNC(regs, RTW_RCR, RTW_RCR);
1895 
1896 	return (phydelay);
1897 #undef REVC
1898 }
1899 
1900 static void rtw_intr_rx(rtw_softc_t *rsc);
1901 static void rtw_ring_recycling(rtw_softc_t *rsc, uint16_t isr, uint32_t pri);
1902 
1903 static int
1904 rtw_get_rate(struct ieee80211com *ic)
1905 {
1906 	uint8_t (*rates)[IEEE80211_RATE_MAXSIZE];
1907 	int rate;
1908 
1909 	rates = &ic->ic_bss->in_rates.ir_rates;
1910 
1911 	if (ic->ic_fixed_rate != IEEE80211_FIXED_RATE_NONE)
1912 		rate = ic->ic_fixed_rate;
1913 	else if (ic->ic_state == IEEE80211_S_RUN)
1914 		rate = (*rates)[ic->ic_bss->in_txrate];
1915 	else
1916 		rate = 0;
1917 	return (rate & IEEE80211_RATE_VAL);
1918 }
1919 
1920 /*
1921  * Arguments in:
1922  *
1923  * paylen:  payload length (no FCS, no WEP header)
1924  *
1925  * hdrlen:  header length
1926  *
1927  * rate:    MSDU speed, units 500kb/s
1928  *
1929  * flags:   IEEE80211_F_SHPREAMBLE (use short preamble),
1930  *          IEEE80211_F_SHSLOT (use short slot length)
1931  *
1932  * Arguments out:
1933  *
1934  * d:       802.11 Duration field for RTS,
1935  *          802.11 Duration field for data frame,
1936  *          PLCP Length for data frame,
1937  *          residual octets at end of data slot
1938  */
1939 static int
1940 rtw_compute_duration1(int len, int use_ack, uint32_t flags, int rate,
1941     struct rtw_ieee80211_duration *d)
1942 {
1943 	int pre, ctsrate;
1944 	uint16_t ack, bitlen, data_dur, remainder;
1945 
1946 	/*
1947 	 * RTS reserves medium for SIFS | CTS | SIFS | (DATA) | SIFS | ACK
1948 	 * DATA reserves medium for SIFS | ACK
1949 	 *
1950 	 * XXXMYC: no ACK on multicast/broadcast or control packets
1951 	 */
1952 
1953 	bitlen = len * 8;
1954 
1955 	pre = IEEE80211_DUR_DS_SIFS;
1956 	if ((flags & IEEE80211_F_SHPREAMBLE) != 0)
1957 		pre += IEEE80211_DUR_DS_SHORT_PREAMBLE +
1958 		    IEEE80211_DUR_DS_FAST_PLCPHDR;
1959 	else
1960 		pre += IEEE80211_DUR_DS_LONG_PREAMBLE +
1961 		    IEEE80211_DUR_DS_SLOW_PLCPHDR;
1962 
1963 	d->d_residue = 0;
1964 	data_dur = (bitlen * 2) / rate;
1965 	remainder = (bitlen * 2) % rate;
1966 	if (remainder != 0) {
1967 		if (rate == 22)
1968 			d->d_residue = (rate - remainder) / 16;
1969 		data_dur++;
1970 	}
1971 
1972 	switch (rate) {
1973 	case 2:		/* 1 Mb/s */
1974 	case 4:		/* 2 Mb/s */
1975 		/* 1 - 2 Mb/s WLAN: send ACK/CTS at 1 Mb/s */
1976 		ctsrate = 2;
1977 		break;
1978 	case 11:	/* 5.5 Mb/s */
1979 	case 22:	/* 11  Mb/s */
1980 	case 44:	/* 22  Mb/s */
1981 		/* 5.5 - 11 Mb/s WLAN: send ACK/CTS at 2 Mb/s */
1982 		ctsrate = 4;
1983 		break;
1984 	default:
1985 		/* TBD */
1986 		return (-1);
1987 	}
1988 
1989 	d->d_plcp_len = data_dur;
1990 
1991 	ack = (use_ack) ? pre + (IEEE80211_DUR_DS_SLOW_ACK * 2) / ctsrate : 0;
1992 
1993 	d->d_rts_dur =
1994 	    pre + (IEEE80211_DUR_DS_SLOW_CTS * 2) / ctsrate +
1995 	    pre + data_dur +
1996 	    ack;
1997 
1998 	d->d_data_dur = ack;
1999 
2000 	return (0);
2001 }
2002 
2003 /*
2004  * Arguments in:
2005  *
2006  * wh:      802.11 header
2007  *
2008  * paylen:  payload length (no FCS, no WEP header)
2009  *
2010  * rate:    MSDU speed, units 500kb/s
2011  *
2012  * fraglen: fragment length, set to maximum (or higher) for no
2013  *          fragmentation
2014  *
2015  * flags:   IEEE80211_F_PRIVACY (hardware adds WEP),
2016  *          IEEE80211_F_SHPREAMBLE (use short preamble),
2017  *          IEEE80211_F_SHSLOT (use short slot length)
2018  *
2019  * Arguments out:
2020  *
2021  * d0: 802.11 Duration fields (RTS/Data), PLCP Length, Service fields
2022  *     of first/only fragment
2023  *
2024  * dn: 802.11 Duration fields (RTS/Data), PLCP Length, Service fields
2025  *     of first/only fragment
2026  */
2027 static int
2028 rtw_compute_duration(struct ieee80211_frame *wh, int len,
2029     uint32_t flags, int fraglen, int rate, struct rtw_ieee80211_duration *d0,
2030     struct rtw_ieee80211_duration *dn, int *npktp)
2031 {
2032 	int ack, rc;
2033 	int firstlen, hdrlen, lastlen, lastlen0, npkt, overlen, paylen;
2034 
2035 	/* don't think about addr4 here */
2036 	hdrlen = sizeof (struct ieee80211_frame);
2037 
2038 	paylen = len - hdrlen;
2039 
2040 	if ((wh->i_fc[1] & IEEE80211_FC1_WEP) != 0) {
2041 		overlen = 8 + IEEE80211_CRC_LEN;
2042 		paylen -= 8;
2043 	} else
2044 		overlen = IEEE80211_CRC_LEN;
2045 
2046 	npkt = paylen / fraglen;
2047 	lastlen0 = paylen % fraglen;
2048 
2049 	if (npkt == 0)			/* no fragments */
2050 		lastlen = paylen + overlen;
2051 	else if (lastlen0 != 0) {	/* a short "tail" fragment */
2052 		lastlen = lastlen0 + overlen;
2053 		npkt++;
2054 	} else			/* full-length "tail" fragment */
2055 		lastlen = fraglen + overlen;
2056 
2057 	if (npktp != NULL)
2058 		*npktp = npkt;
2059 
2060 	if (npkt > 1)
2061 		firstlen = fraglen + overlen;
2062 	else
2063 		firstlen = paylen + overlen;
2064 
2065 	ack = !IEEE80211_IS_MULTICAST(wh->i_addr1) &&
2066 	    (wh->i_fc[1] & IEEE80211_FC0_TYPE_MASK) !=
2067 	    IEEE80211_FC0_TYPE_CTL;
2068 
2069 	rc = rtw_compute_duration1(firstlen + hdrlen,
2070 	    ack, flags, rate, d0);
2071 	if (rc == -1)
2072 		return (rc);
2073 
2074 	if (npkt <= 1) {
2075 		*dn = *d0;
2076 		return (0);
2077 	}
2078 	return (rtw_compute_duration1(lastlen + hdrlen, ack, flags,
2079 	    rate, dn));
2080 }
2081 
2082 static int
2083 rtw_assembly_80211(rtw_softc_t *rsc, struct rtw_txbuf *bf,
2084     mblk_t *mp)
2085 {
2086 	ieee80211com_t *ic;
2087 	struct rtw_txdesc *ds;
2088 	struct ieee80211_frame *wh;
2089 	uint8_t *buf;
2090 	uint32_t ctl0 = 0, ctl1 = 0;
2091 	int npkt, rate;
2092 	struct rtw_ieee80211_duration d0, dn;
2093 	int32_t iswep, pktlen, mblen;
2094 	mblk_t *mp0;
2095 
2096 	ic = &rsc->sc_ic;
2097 	ds = bf->txdesc;
2098 	buf = (uint8_t *)bf->bf_dma.mem_va;
2099 	bzero(buf, bf->bf_dma.alength);
2100 	bzero((uint8_t *)ds, sizeof (struct rtw_txdesc));
2101 	wh = (struct ieee80211_frame *)mp->b_rptr;
2102 	iswep = wh->i_fc[1] & IEEE80211_FC1_WEP;
2103 
2104 	/* ieee80211_crypto_encap() needs a single mblk */
2105 	mp0 = allocb(bf->bf_dma.alength, BPRI_MED);
2106 	if (mp0 == NULL) {
2107 		cmn_err(CE_WARN, "%s: allocb(mp) error", __func__);
2108 		return (-1);
2109 	}
2110 	for (; mp != NULL; mp = mp->b_cont) {
2111 			mblen = (uintptr_t)mp->b_wptr - (uintptr_t)mp->b_rptr;
2112 			bcopy(mp->b_rptr, mp0->b_wptr, mblen);
2113 			mp0->b_wptr += mblen;
2114 	}
2115 
2116 	if (iswep) {
2117 		struct ieee80211_key *k;
2118 
2119 		k = ieee80211_crypto_encap(ic, mp0);
2120 		if (k == NULL) {
2121 			cmn_err(CE_WARN, "%s: ieee80211_crypto_encap() error",
2122 			    __func__);
2123 			freemsg(mp0);
2124 			return (-1);
2125 		}
2126 	}
2127 	pktlen = msgdsize(mp0);
2128 
2129 #if 0
2130 	RTW_DPRINTF(RTW_DEBUG_XMIT, "-----------send------begin--------");
2131 	ieee80211_dump_pkt((uint8_t *)(mp0->b_rptr), pktlen, 0, 0);
2132 	RTW_DPRINTF(RTW_DEBUG_XMIT, "-----------send------end--------");
2133 #endif
2134 	/* RTW_DMA_SYNC(bf->bf_dma, DDI_DMA_SYNC_FORDEV); */
2135 	if (pktlen > bf->bf_dma.alength) {
2136 		cmn_err(CE_WARN, "%s: overlength packet pktlen = %d\n",
2137 		    __func__, pktlen);
2138 		freemsg(mp0);
2139 		return (-1);
2140 	}
2141 	bcopy(mp0->b_rptr, buf, pktlen);
2142 	RTW_DMA_SYNC(bf->bf_dma, DDI_DMA_SYNC_FORDEV);
2143 
2144 	/* setup descriptor */
2145 	ctl0 = RTW_TXCTL0_RTSRATE_1MBPS;
2146 
2147 	if (((ic->ic_flags & IEEE80211_F_SHPREAMBLE) != 0) &&
2148 	    (ic->ic_bss->in_capinfo & IEEE80211_CAPINFO_SHORT_PREAMBLE)) {
2149 		ctl0 |= RTW_TXCTL0_SPLCP;
2150 	}
2151 	/* XXX do real rate control */
2152 	if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) ==
2153 	    IEEE80211_FC0_TYPE_MGT)
2154 		rate = 2;
2155 	else {
2156 		rate = MAX(2, rtw_get_rate(ic));
2157 	}
2158 	ctl0 = ctl0 |
2159 	    LSHIFT(pktlen, RTW_TXCTL0_TPKTSIZE_MASK);
2160 
2161 	RTW_DPRINTF(RTW_DEBUG_XMIT, "%s: rate = %d", __func__, rate);
2162 
2163 	switch (rate) {
2164 	default:
2165 	case 2:
2166 		ctl0 |= RTW_TXCTL0_RATE_1MBPS;
2167 		break;
2168 	case 4:
2169 		ctl0 |= RTW_TXCTL0_RATE_2MBPS;
2170 		break;
2171 	case 11:
2172 		ctl0 |= RTW_TXCTL0_RATE_5MBPS;
2173 		break;
2174 	case 22:
2175 		ctl0 |= RTW_TXCTL0_RATE_11MBPS;
2176 		break;
2177 	}
2178 
2179 	/* XXX >= ? Compare after fragmentation? */
2180 	if (pktlen > ic->ic_rtsthreshold) {
2181 		ctl0 |= RTW_TXCTL0_RTSEN;
2182 		cmn_err(CE_NOTE, "%s: fragmentation: pktlen = %d",
2183 		    __func__, pktlen);
2184 	}
2185 
2186 	if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) ==
2187 	    IEEE80211_FC0_TYPE_MGT) {
2188 		ctl0 &= ~(RTW_TXCTL0_SPLCP | RTW_TXCTL0_RTSEN);
2189 		if ((wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) ==
2190 		    IEEE80211_FC0_SUBTYPE_BEACON)
2191 			ctl0 |= RTW_TXCTL0_BEACON;
2192 	}
2193 
2194 	if (rtw_compute_duration(wh, pktlen,
2195 	    ic->ic_flags, ic->ic_fragthreshold,
2196 	    rate, &d0, &dn, &npkt) == -1) {
2197 		RTW_DPRINTF(RTW_DEBUG_XMIT,
2198 		    "%s: fail compute duration\n", __func__);
2199 		freemsg(mp0);
2200 		return (-1);
2201 	}
2202 	*(uint16_t *)(uintptr_t)wh->i_dur = (d0.d_data_dur);
2203 
2204 	ctl1 = LSHIFT(d0.d_plcp_len, RTW_TXCTL1_LENGTH_MASK) |
2205 	    LSHIFT(d0.d_rts_dur, RTW_TXCTL1_RTSDUR_MASK);
2206 
2207 	if (d0.d_residue)
2208 		ctl1 |= RTW_TXCTL1_LENGEXT;
2209 
2210 	RTW_DPRINTF(RTW_DEBUG_XMIT, "%s: duration=%x, ctl1=%x", __func__,
2211 	    *(uint16_t *)(uintptr_t)wh->i_dur, ctl1);
2212 
2213 	if (bf->bf_dma.alength > RTW_TXLEN_LENGTH_MASK) {
2214 		RTW_DPRINTF(RTW_DEBUG_XMIT,
2215 		    "%s: seg too long\n", __func__);
2216 		freemsg(mp0);
2217 		return (-1);
2218 	}
2219 	ds->td_ctl0 = ctl0;
2220 	ds->td_ctl0 |= RTW_TXCTL0_OWN | RTW_TXCTL0_LS | RTW_TXCTL0_FS;
2221 	ds->td_ctl1 = ctl1;
2222 	ds->td_buf = bf->bf_dma.cookie.dmac_address;
2223 	ds->td_len = pktlen & 0xfff;
2224 	ds->td_next = bf->next_bf_daddr;
2225 
2226 	RTW_DMA_SYNC_DESC(rsc->sc_desc_dma,
2227 	    RTW_DESC_OFFSET(hd_txmd, bf->order),
2228 	    sizeof (struct rtw_txdesc),
2229 	    DDI_DMA_SYNC_FORDEV);
2230 
2231 	RTW_DPRINTF(RTW_DEBUG_XMIT,
2232 	    "descriptor: order = %d, phy_addr=%x, ctl0=%x,"
2233 	    " ctl1=%x, buf=%x, len=%x, next=%x", bf->order,
2234 	    bf->bf_daddr, ds->td_ctl0, ds->td_ctl1,
2235 	    ds->td_buf, ds->td_len, ds->td_next);
2236 	rsc->sc_pktxmt64++;
2237 	rsc->sc_bytexmt64 += pktlen;
2238 
2239 	freemsg(mp0);
2240 	return (0);
2241 }
2242 
2243 static int
2244 rtw_send(ieee80211com_t *ic, mblk_t *mp, uint8_t type)
2245 {
2246 	rtw_softc_t *rsc = (rtw_softc_t *)ic;
2247 	struct ieee80211_node *in = ic->ic_bss;
2248 	struct rtw_txbuf *bf = NULL;
2249 	int ret, i = RTW_TXPRIMD;
2250 
2251 	mutex_enter(&rsc->sc_txlock);
2252 	mutex_enter(&rsc->sc_txq[i].txbuf_lock);
2253 	bf = list_head(&rsc->sc_txq[i].tx_free_list);
2254 
2255 	if ((bf == NULL) || (rsc->sc_txq[i].tx_nfree <= 4)) {
2256 		RTW_DPRINTF(RTW_DEBUG_XMIT, "%s: no tx buf\n", __func__);
2257 		rsc->sc_noxmtbuf++;
2258 		if ((type & IEEE80211_FC0_TYPE_MASK) ==
2259 		    IEEE80211_FC0_TYPE_DATA) {
2260 			RTW_DPRINTF(RTW_DEBUG_XMIT, "%s: need reschedule\n",
2261 			    __func__);
2262 			rsc->sc_need_reschedule = 1;
2263 		} else {
2264 			freemsg(mp);
2265 		}
2266 		mutex_exit(&rsc->sc_txq[i].txbuf_lock);
2267 		mutex_exit(&rsc->sc_txlock);
2268 		return (1);
2269 	}
2270 	list_remove(&rsc->sc_txq[i].tx_free_list, bf);
2271 	rsc->sc_txq[i].tx_nfree--;
2272 
2273 	/* assemble 802.11 frame here */
2274 	ret = rtw_assembly_80211(rsc, bf, mp);
2275 	if (ret != 0) {
2276 		cmn_err(CE_WARN, "%s assembly frame error\n", __func__);
2277 		mutex_exit(&rsc->sc_txq[i].txbuf_lock);
2278 		mutex_exit(&rsc->sc_txlock);
2279 		if ((type & IEEE80211_FC0_TYPE_MASK) !=
2280 		    IEEE80211_FC0_TYPE_DATA) {
2281 			freemsg(mp);
2282 		}
2283 		return (1);
2284 	}
2285 	list_insert_tail(&rsc->sc_txq[i].tx_dirty_list, bf);
2286 	bf->bf_in = in;
2287 	rtw_dma_start(&rsc->sc_regs, i);
2288 
2289 	mutex_exit(&rsc->sc_txq[i].txbuf_lock);
2290 	mutex_exit(&rsc->sc_txlock);
2291 
2292 	freemsg(mp);
2293 	return (0);
2294 }
2295 
2296 static mblk_t *
2297 rtw_m_tx(void *arg, mblk_t *mp)
2298 {
2299 	rtw_softc_t *rsc = arg;
2300 	ieee80211com_t *ic = (ieee80211com_t *)rsc;
2301 	mblk_t *next;
2302 
2303 	if (ic->ic_state != IEEE80211_S_RUN) {
2304 		freemsgchain(mp);
2305 		return (NULL);
2306 	}
2307 
2308 	while (mp != NULL) {
2309 		next = mp->b_next;
2310 		mp->b_next = NULL;
2311 
2312 		if (rtw_send(ic, mp, IEEE80211_FC0_TYPE_DATA)) {
2313 			mp->b_next = next;
2314 			break;
2315 		}
2316 		mp = next;
2317 	}
2318 
2319 	return (mp);
2320 
2321 }
2322 
2323 static void
2324 rtw_next_scan(void *arg)
2325 {
2326 	ieee80211com_t *ic = arg;
2327 	rtw_softc_t *rsc = (rtw_softc_t *)arg;
2328 
2329 	rsc->sc_scan_id = 0;
2330 	if (ic->ic_state == IEEE80211_S_SCAN) {
2331 		RTW_DPRINTF(RTW_DEBUG_TUNE, "rtw_next_scan\n");
2332 		(void) ieee80211_next_scan(ic);
2333 	}
2334 
2335 }
2336 
2337 static void
2338 rtw_join_bss(rtw_softc_t *rsc, uint8_t *bssid, uint16_t intval0)
2339 {
2340 	uint16_t bcnitv, intval;
2341 	int i;
2342 	struct rtw_regs *regs = &rsc->sc_regs;
2343 
2344 	for (i = 0; i < IEEE80211_ADDR_LEN; i++)
2345 		RTW_WRITE8(regs, RTW_BSSID + i, bssid[i]);
2346 
2347 	RTW_SYNC(regs, RTW_BSSID16, RTW_BSSID32);
2348 	rtw_set_access(regs, RTW_ACCESS_CONFIG);
2349 
2350 	RTW_WRITE8(regs, RTW_MSR, 0x8);	/* sta mode link ok */
2351 	intval = MIN(intval0, PRESHIFT(RTW_BCNITV_BCNITV_MASK));
2352 
2353 	bcnitv = RTW_READ16(regs, RTW_BCNITV) & ~RTW_BCNITV_BCNITV_MASK;
2354 	bcnitv |= LSHIFT(intval, RTW_BCNITV_BCNITV_MASK);
2355 	RTW_WRITE16(regs, RTW_BCNITV, bcnitv);
2356 	RTW_WRITE16(regs, RTW_ATIMWND, LSHIFT(1, RTW_ATIMWND_ATIMWND));
2357 	RTW_WRITE16(regs, RTW_ATIMTRITV, LSHIFT(2, RTW_ATIMTRITV_ATIMTRITV));
2358 
2359 	rtw_set_access(regs, RTW_ACCESS_NONE);
2360 
2361 	/* TBD WEP */
2362 	/* RTW_WRITE8(regs, RTW_SCR, 0); */
2363 
2364 	rtw_io_enable(rsc, RTW_CR_RE | RTW_CR_TE, 1);
2365 }
2366 
2367 /*
2368  * Set the starting transmit rate for a node.
2369  */
2370 static void
2371 rtw_rate_ctl_start(rtw_softc_t *rsc, struct ieee80211_node *in)
2372 {
2373 	ieee80211com_t *ic = (ieee80211com_t *)rsc;
2374 	int32_t srate;
2375 
2376 	if (ic->ic_fixed_rate == IEEE80211_FIXED_RATE_NONE) {
2377 		/*
2378 		 * No fixed rate is requested. For 11b start with
2379 		 * the highest negotiated rate; otherwise, for 11g
2380 		 * and 11a, we start "in the middle" at 24Mb or 36Mb.
2381 		 */
2382 		srate = in->in_rates.ir_nrates - 1;
2383 		if (ic->ic_curmode != IEEE80211_MODE_11B) {
2384 			/*
2385 			 * Scan the negotiated rate set to find the
2386 			 * closest rate.
2387 			 */
2388 			/* NB: the rate set is assumed sorted */
2389 			for (; srate >= 0 && IEEE80211_RATE(srate) > 72;
2390 			    srate--)
2391 				;
2392 		}
2393 	} else {
2394 		/*
2395 		 * A fixed rate is to be used;  We know the rate is
2396 		 * there because the rate set is checked when the
2397 		 * station associates.
2398 		 */
2399 		/* NB: the rate set is assumed sorted */
2400 		srate = in->in_rates.ir_nrates - 1;
2401 		for (; srate >= 0 && IEEE80211_RATE(srate) != ic->ic_fixed_rate;
2402 		    srate--)
2403 			;
2404 	}
2405 	in->in_txrate = srate;
2406 }
2407 
2408 
2409 /*
2410  * Reset the rate control state for each 802.11 state transition.
2411  */
2412 static void
2413 rtw_rate_ctl_reset(rtw_softc_t *rsc, enum ieee80211_state state)
2414 {
2415 	ieee80211com_t *ic = &rsc->sc_ic;
2416 	ieee80211_node_t *in;
2417 
2418 	if (ic->ic_opmode == IEEE80211_M_STA) {
2419 		/*
2420 		 * Reset local xmit state; this is really only
2421 		 * meaningful when operating in station mode.
2422 		 */
2423 		in = (struct ieee80211_node *)ic->ic_bss;
2424 
2425 		if (state == IEEE80211_S_RUN) {
2426 			rtw_rate_ctl_start(rsc, in);
2427 		} else {
2428 			in->in_txrate = 0;
2429 		}
2430 	}
2431 }
2432 
2433 /*
2434  * Examine and potentially adjust the transmit rate.
2435  */
2436 static void
2437 rtw_rate_ctl(void *arg)
2438 {
2439 	ieee80211com_t	*ic = (ieee80211com_t *)arg;
2440 	rtw_softc_t *rsc = (rtw_softc_t *)ic;
2441 	struct ieee80211_node *in = ic->ic_bss;
2442 	struct ieee80211_rateset *rs = &in->in_rates;
2443 	int32_t mod = 1, nrate, enough;
2444 
2445 	mutex_enter(&rsc->sc_genlock);
2446 	enough = (rsc->sc_tx_ok + rsc->sc_tx_err) >= 600? 1 : 0;
2447 
2448 	/* err ratio is high -> down */
2449 	if (enough && rsc->sc_tx_ok < rsc->sc_tx_err)
2450 		mod = -1;
2451 
2452 	nrate = in->in_txrate;
2453 	switch (mod) {
2454 	case -1:
2455 		if (nrate > 0) {
2456 			nrate--;
2457 		}
2458 		break;
2459 	case 1:
2460 		if (nrate + 1 < rs->ir_nrates) {
2461 			nrate++;
2462 		}
2463 		break;
2464 	}
2465 
2466 	if (nrate != in->in_txrate)
2467 		in->in_txrate = nrate;
2468 	rsc->sc_tx_ok = rsc->sc_tx_err = rsc->sc_tx_retr = 0;
2469 	mutex_exit(&rsc->sc_genlock);
2470 	if (ic->ic_state == IEEE80211_S_RUN)
2471 		rsc->sc_ratectl_id = timeout(rtw_rate_ctl, ic,
2472 		    drv_usectohz(1000000));
2473 }
2474 
2475 static int32_t
2476 rtw_new_state(ieee80211com_t *ic, enum ieee80211_state nstate, int arg)
2477 {
2478 	rtw_softc_t *rsc = (rtw_softc_t *)ic;
2479 	int error;
2480 	enum ieee80211_state ostate;
2481 
2482 	ostate = ic->ic_state;
2483 
2484 	RTW_DPRINTF(RTW_DEBUG_ATTACH,
2485 	    "rtw_new_state: ostate:0x%x, nstate:0x%x, opmode:0x%x\n",
2486 	    ostate, nstate, ic->ic_opmode);
2487 
2488 
2489 	mutex_enter(&rsc->sc_genlock);
2490 	if (rsc->sc_scan_id != 0) {
2491 		(void) untimeout(rsc->sc_scan_id);
2492 		rsc->sc_scan_id = 0;
2493 	}
2494 	if (rsc->sc_ratectl_id != 0) {
2495 		(void) untimeout(rsc->sc_ratectl_id);
2496 		rsc->sc_ratectl_id = 0;
2497 	}
2498 	rtw_rate_ctl_reset(rsc, nstate);
2499 	if (ostate == IEEE80211_S_INIT && nstate != IEEE80211_S_INIT)
2500 		(void) rtw_pwrstate(rsc, RTW_ON);
2501 	if (nstate != IEEE80211_S_INIT) {
2502 		if ((error = rtw_tune(rsc)) != 0) {
2503 			mutex_exit(&rsc->sc_genlock);
2504 			return (error);
2505 		}
2506 	}
2507 	switch (nstate) {
2508 	case IEEE80211_S_INIT:
2509 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw_new_state: S_INIT\n");
2510 		break;
2511 	case IEEE80211_S_SCAN:
2512 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw_new_state: S_SCAN\n");
2513 		rsc->sc_scan_id = timeout(rtw_next_scan, ic,
2514 		    drv_usectohz(200000));
2515 		rtw_set_nettype(rsc, IEEE80211_M_MONITOR);
2516 		break;
2517 	case IEEE80211_S_RUN:
2518 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw_new_state: S_RUN\n");
2519 		switch (ic->ic_opmode) {
2520 		case IEEE80211_M_HOSTAP:
2521 		case IEEE80211_M_IBSS:
2522 			rtw_set_nettype(rsc, IEEE80211_M_MONITOR);
2523 			/* TBD */
2524 			/*FALLTHROUGH*/
2525 		case IEEE80211_M_AHDEMO:
2526 		case IEEE80211_M_STA:
2527 			RTW_DPRINTF(RTW_DEBUG_ATTACH,
2528 			    "rtw_new_state: sta\n");
2529 			rtw_join_bss(rsc, ic->ic_bss->in_bssid, 0);
2530 			rsc->sc_ratectl_id = timeout(rtw_rate_ctl, ic,
2531 			    drv_usectohz(1000000));
2532 			break;
2533 		case IEEE80211_M_MONITOR:
2534 			break;
2535 		}
2536 		rtw_set_nettype(rsc, ic->ic_opmode);
2537 		break;
2538 	case IEEE80211_S_ASSOC:
2539 	case IEEE80211_S_AUTH:
2540 		break;
2541 	}
2542 
2543 	mutex_exit(&rsc->sc_genlock);
2544 	/*
2545 	 * Invoke the parent method to complete the work.
2546 	 */
2547 	error = rsc->sc_newstate(ic, nstate, arg);
2548 
2549 	return (error);
2550 }
2551 
2552 static void
2553 rtw_intr_rx(rtw_softc_t *rsc)
2554 {
2555 #define	IS_BEACON(__fc0)						\
2556 	((__fc0 & (IEEE80211_FC0_TYPE_MASK | IEEE80211_FC0_SUBTYPE_MASK)) ==\
2557 	(IEEE80211_FC0_TYPE_MGT | IEEE80211_FC0_SUBTYPE_BEACON))
2558 	/*
2559 	 * ratetbl[4] = {2, 4, 11, 22};
2560 	 */
2561 	struct rtw_rxbuf *bf;
2562 	struct rtw_rxdesc *ds;
2563 	int hwrate, len, rssi;
2564 	uint32_t hstat, hrssi, htsftl;
2565 	int is_last, next, n = 0, i;
2566 	struct ieee80211_frame *wh;
2567 	ieee80211com_t *ic = (ieee80211com_t *)rsc;
2568 	mblk_t *mp;
2569 
2570 	RTW_DPRINTF(RTW_DEBUG_RECV, "%s rtw_intr_rx: enter ic_state=%x\n",
2571 	    __func__, rsc->sc_ic.ic_state);
2572 	mutex_enter(&rsc->rxbuf_lock);
2573 	next = rsc->rx_next;
2574 	mutex_exit(&rsc->rxbuf_lock);
2575 	for (i = 0; i < RTW_RXQLEN; i++) {
2576 		RTW_DMA_SYNC_DESC(rsc->sc_desc_dma,
2577 		    RTW_DESC_OFFSET(hd_rx, next),
2578 		    sizeof (struct rtw_rxdesc),
2579 		    DDI_DMA_SYNC_FORKERNEL);
2580 		n++;
2581 		bf = rsc->rxbuf_h + next;
2582 		ds = bf->rxdesc;
2583 		hstat = (ds->rd_stat);
2584 		hrssi = ds->rd_rssi;
2585 		htsftl = ds->rd_tsftl;
2586 		/* htsfth = ds->rd_tsfth; */
2587 		RTW_DPRINTF(RTW_DEBUG_RECV, "%s: stat=%x\n", __func__, hstat);
2588 		/* still belongs to NIC */
2589 		if ((hstat & RTW_RXSTAT_OWN) != 0) {
2590 			if (n > 1) {
2591 				RTW_DPRINTF(RTW_DEBUG_RECV,
2592 				    "%s: n > 1\n", __func__);
2593 				break;
2594 			}
2595 			RTW_DMA_SYNC_DESC(rsc->sc_desc_dma,
2596 			    RTW_DESC_OFFSET(hd_rx, 0),
2597 			    sizeof (struct rtw_rxdesc),
2598 			    DDI_DMA_SYNC_FORCPU);
2599 			bf = rsc->rxbuf_h;
2600 			ds = bf->rxdesc;
2601 			hstat = (ds->rd_stat);
2602 			if ((hstat & RTW_RXSTAT_OWN) != 0)
2603 				break;
2604 			next = 0 /* RTW_RXQLEN - 1 */;
2605 			continue;
2606 		}
2607 
2608 		rsc->sc_pktrcv64++;
2609 		if ((hstat & RTW_RXSTAT_IOERROR) != 0) {
2610 			RTW_DPRINTF(RTW_DEBUG_RECV,
2611 			    "rtw: DMA error/FIFO overflow %08x, "
2612 			    "rx descriptor %d\n",
2613 			    hstat & RTW_RXSTAT_IOERROR, next);
2614 			goto next;
2615 		}
2616 
2617 		len = MASK_AND_RSHIFT(hstat, RTW_RXSTAT_LENGTH_MASK);
2618 		rsc->sc_bytercv64 += len;
2619 
2620 		/* CRC is included with the packet; trim it off. */
2621 		/* len -= IEEE80211_CRC_LEN; */
2622 
2623 		hwrate = MASK_AND_RSHIFT(hstat, RTW_RXSTAT_RATE_MASK);
2624 		if (hwrate >= 4) {
2625 			goto next;
2626 		}
2627 
2628 		if ((hstat & RTW_RXSTAT_RES) != 0 &&
2629 		    rsc->sc_ic.ic_opmode != IEEE80211_M_MONITOR) {
2630 			goto next;
2631 		}
2632 
2633 		/* if bad flags, skip descriptor */
2634 		if ((hstat & RTW_RXSTAT_ONESEG) != RTW_RXSTAT_ONESEG) {
2635 			RTW_DPRINTF(RTW_DEBUG_RECV,
2636 			    "rtw too many rx segments\n");
2637 			goto next;
2638 		}
2639 
2640 		if (rsc->sc_rfchipid == RTW_RFCHIPID_PHILIPS)
2641 			rssi = MASK_AND_RSHIFT(hrssi, RTW_RXRSSI_RSSI);
2642 		else {
2643 			rssi = MASK_AND_RSHIFT(hrssi, RTW_RXRSSI_IMR_RSSI);
2644 			/*
2645 			 * TBD find out each front-end's LNA gain in the
2646 			 * front-end's units
2647 			 */
2648 			if ((hrssi & RTW_RXRSSI_IMR_LNA) == 0)
2649 				rssi |= 0x80;
2650 		}
2651 		/* sq = MASK_AND_RSHIFT(hrssi, RTW_RXRSSI_SQ); */
2652 
2653 
2654 		/* deal with the frame itself here */
2655 		mp = allocb(rsc->sc_dmabuf_size, BPRI_MED);
2656 		if (mp == NULL) {
2657 			cmn_err(CE_WARN, "rtw: alloc mblk error");
2658 			rsc->sc_norcvbuf++;
2659 			return;
2660 		}
2661 		len -= IEEE80211_CRC_LEN;
2662 		RTW_DMA_SYNC(bf->bf_dma, DDI_DMA_SYNC_FORKERNEL);
2663 		bcopy(bf->bf_dma.mem_va, mp->b_rptr, len);
2664 		mp->b_wptr += len;
2665 		wh = (struct ieee80211_frame *)mp->b_rptr;
2666 		if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) ==
2667 		    IEEE80211_FC0_TYPE_CTL) {
2668 			cmn_err(CE_WARN, "TYPE CTL !!\n");
2669 			freemsg(mp);
2670 			goto next;
2671 		}
2672 		(void) ieee80211_input(ic, mp, ic->ic_bss, rssi, htsftl);
2673 next:
2674 		if (next == 63)
2675 			is_last = 1;
2676 		else
2677 			is_last = 0;
2678 		rtw_rxdesc_init(rsc, bf, next, is_last);
2679 
2680 		next = (next + 1)%RTW_RXQLEN;
2681 		RTW_DPRINTF(RTW_DEBUG_RECV, "%s: next = %d\n", __func__, next);
2682 	}
2683 	mutex_enter(&rsc->rxbuf_lock);
2684 	rsc->rx_next = next;
2685 	mutex_exit(&rsc->rxbuf_lock);
2686 }
2687 
2688 static void
2689 rtw_ring_recycling(rtw_softc_t *rsc, uint16_t isr, uint32_t pri)
2690 {
2691 	struct rtw_txbuf *bf;
2692 	struct rtw_txdesc *ds;
2693 	uint32_t hstat;
2694 	uint32_t  head = 0;
2695 	uint32_t  cnt = 0, idx = 0;
2696 
2697 	mutex_enter(&rsc->sc_txq[pri].txbuf_lock);
2698 	head = RTW_READ(&rsc->sc_regs, RTW_TNPDA);
2699 	if (head == rsc->hw_go) {
2700 		mutex_exit(&rsc->sc_txq[pri].txbuf_lock);
2701 		return;
2702 	}
2703 	RTW_DPRINTF(RTW_DEBUG_XMIT, "rtw_ring_recycling: enter ic_state=%x\n",
2704 	    rsc->sc_ic.ic_state);
2705 
2706 	bf = list_head(&rsc->sc_txq[pri].tx_dirty_list);
2707 	if (bf == NULL) {
2708 		RTW_DPRINTF(RTW_DEBUG_XMIT,
2709 		    "rtw_ring_recycling: dirty bf[%d] NULL\n", pri);
2710 		mutex_exit(&rsc->sc_txq[pri].txbuf_lock);
2711 		return;
2712 	}
2713 
2714 	while ((bf != NULL) && (rsc->hw_go != head)) {
2715 		cnt++;
2716 		idx = (rsc->hw_go - rsc->hw_start) / sizeof (struct rtw_txdesc);
2717 		if (idx == 63)
2718 			rsc->hw_go = rsc->hw_start;
2719 		else
2720 			rsc->hw_go += sizeof (struct rtw_txdesc);
2721 		RTW_DMA_SYNC_DESC(rsc->sc_desc_dma,
2722 		    RTW_DESC_OFFSET(hd_txmd, idx),
2723 		    sizeof (struct rtw_txdesc),
2724 		    DDI_DMA_SYNC_FORCPU);
2725 
2726 		RTW_DPRINTF(RTW_DEBUG_XMIT, "Head = 0x%x\n", head);
2727 		ds = bf->txdesc;
2728 		hstat = (ds->td_stat);
2729 		ds->td_len = ds->td_len & 0xfff;
2730 		RTW_DPRINTF(RTW_DEBUG_XMIT,
2731 		    "%s rtw_ring_recycling: stat=%x, pri=%x\n",
2732 		    __func__, hstat, pri);
2733 		if (hstat & RTW_TXSTAT_TOK)
2734 			rsc->sc_tx_ok++;
2735 		else {
2736 			RTW_DPRINTF(RTW_DEBUG_XMIT,
2737 			    "TX err @%d, o %d, retry[%d], isr[0x%x], cnt %d\n",
2738 			    idx, (hstat & RTW_TXSTAT_OWN)?1:0,
2739 			    (hstat & RTW_TXSTAT_DRC_MASK), isr, cnt);
2740 			if ((hstat & RTW_TXSTAT_DRC_MASK) <= 4) {
2741 				rsc->sc_tx_ok++;
2742 			} else {
2743 				rsc->sc_tx_err++;
2744 			}
2745 		}
2746 		rsc->sc_tx_retr +=
2747 		    (hstat & RTW_TXSTAT_DRC_MASK);
2748 		rsc->sc_xmtretry +=
2749 		    (hstat & RTW_TXSTAT_DRC_MASK);
2750 		list_remove(&rsc->sc_txq[pri].tx_dirty_list, bf);
2751 		list_insert_tail(&rsc->sc_txq[pri].tx_free_list,
2752 		    bf);
2753 		(rsc->sc_txq[pri].tx_nfree)++;
2754 		if (rsc->sc_need_reschedule == 1) {
2755 			mac_tx_update(rsc->sc_ic.ic_mach);
2756 			rsc->sc_need_reschedule = 0;
2757 		}
2758 		RTW_DPRINTF(RTW_DEBUG_XMIT,
2759 		    "rtw_ring_recycling: nfree[%d]=%d\n",
2760 		    pri, rsc->sc_txq[pri].tx_nfree);
2761 		bzero((uint8_t *)ds, sizeof (struct rtw_txdesc));
2762 		RTW_DMA_SYNC_DESC(rsc->sc_desc_dma,
2763 		    RTW_DESC_OFFSET(hd_txmd, idx),
2764 		    sizeof (struct rtw_txdesc),
2765 		    DDI_DMA_SYNC_FORDEV);
2766 		bf = list_head(&rsc->sc_txq[pri].tx_dirty_list);
2767 	}
2768 	mutex_exit(&rsc->sc_txq[pri].txbuf_lock);
2769 }
2770 
2771 static void
2772 rtw_intr_timeout(rtw_softc_t *rsc)
2773 {
2774 	rtw_resume_ticks(rsc);
2775 }
2776 
2777 static uint_t
2778 rtw_intr(caddr_t arg)
2779 {
2780 	/* LINTED E_BAD_PTR_CAST_ALIGN */
2781 	rtw_softc_t *rsc = (rtw_softc_t *)arg;
2782 	struct rtw_regs *regs = &rsc->sc_regs;
2783 	uint16_t isr = 0;
2784 
2785 	mutex_enter(&rsc->sc_genlock);
2786 	isr = RTW_READ16(regs, RTW_ISR);
2787 	RTW_WRITE16(regs, RTW_ISR, isr);
2788 
2789 	if (isr == 0) {
2790 		mutex_exit(&rsc->sc_genlock);
2791 		return (DDI_INTR_UNCLAIMED);
2792 	}
2793 
2794 #ifdef DEBUG
2795 #define	PRINTINTR(flag) { \
2796 	if ((isr & flag) != 0) { \
2797 		RTW_DPRINTF(RTW_DEBUG_INTR, "|" #flag); \
2798 	} \
2799 }
2800 
2801 	if ((rtw_dbg_flags & RTW_DEBUG_INTR) != 0 && isr != 0) {
2802 
2803 		RTW_DPRINTF(RTW_DEBUG_INTR, "rtw: reg[ISR] = %x", isr);
2804 
2805 		PRINTINTR(RTW_INTR_TXFOVW);
2806 		PRINTINTR(RTW_INTR_TIMEOUT);
2807 		PRINTINTR(RTW_INTR_BCNINT);
2808 		PRINTINTR(RTW_INTR_ATIMINT);
2809 		PRINTINTR(RTW_INTR_TBDER);
2810 		PRINTINTR(RTW_INTR_TBDOK);
2811 		PRINTINTR(RTW_INTR_THPDER);
2812 		PRINTINTR(RTW_INTR_THPDOK);
2813 		PRINTINTR(RTW_INTR_TNPDER);
2814 		PRINTINTR(RTW_INTR_TNPDOK);
2815 		PRINTINTR(RTW_INTR_RXFOVW);
2816 		PRINTINTR(RTW_INTR_RDU);
2817 		PRINTINTR(RTW_INTR_TLPDER);
2818 		PRINTINTR(RTW_INTR_TLPDOK);
2819 		PRINTINTR(RTW_INTR_RER);
2820 		PRINTINTR(RTW_INTR_ROK);
2821 	}
2822 #undef PRINTINTR
2823 #endif /* DEBUG */
2824 
2825 	rsc->sc_intr++;
2826 
2827 	if ((isr & RTW_INTR_RX) != 0) {
2828 		mutex_exit(&rsc->sc_genlock);
2829 		rtw_intr_rx(rsc);
2830 		mutex_enter(&rsc->sc_genlock);
2831 	}
2832 	if ((isr & RTW_INTR_TIMEOUT) != 0)
2833 		rtw_intr_timeout(rsc);
2834 
2835 	if ((isr & RTW_INTR_TX) != 0)
2836 		rtw_ring_recycling(rsc, isr, 1);
2837 	mutex_exit(&rsc->sc_genlock);
2838 	return (DDI_INTR_CLAIMED);
2839 }
2840 
2841 static void
2842 rtw_stop(void *arg)
2843 {
2844 	rtw_softc_t *rsc = (rtw_softc_t *)arg;
2845 	struct rtw_regs *regs = &rsc->sc_regs;
2846 
2847 	mutex_enter(&rsc->sc_genlock);
2848 	rtw_disable_interrupts(regs);
2849 	rtw_io_enable(rsc, RTW_CR_RE | RTW_CR_TE, 0);
2850 	RTW_WRITE8(regs, RTW_TPPOLL, RTW_TPPOLL_SALL);
2851 	rsc->sc_invalid = 1;
2852 	mutex_exit(&rsc->sc_genlock);
2853 }
2854 
2855 static void
2856 rtw_m_stop(void *arg)
2857 {
2858 	rtw_softc_t *rsc = (rtw_softc_t *)arg;
2859 
2860 	(void) ieee80211_new_state(&rsc->sc_ic, IEEE80211_S_INIT, -1);
2861 	rtw_stop(rsc);
2862 }
2863 
2864 /*
2865  * quiesce(9E) entry point.
2866  *
2867  * This function is called when the system is single-threaded at high
2868  * PIL with preemption disabled. Therefore, this function must not be
2869  * blocked.
2870  *
2871  * This function returns DDI_SUCCESS on success, or DDI_FAILURE on failure.
2872  * DDI_FAILURE indicates an error condition and should almost never happen.
2873  */
2874 int
2875 rtw_quiesce(dev_info_t *dip)
2876 {
2877 	rtw_softc_t  *rsc = NULL;
2878 	struct rtw_regs *regs;
2879 
2880 	rsc = ddi_get_soft_state(rtw_soft_state_p, ddi_get_instance(dip));
2881 	ASSERT(rsc != NULL);
2882 	regs = &rsc->sc_regs;
2883 
2884 	rtw_dbg_flags = 0;
2885 	rtw_disable_interrupts(regs);
2886 	rtw_io_enable(rsc, RTW_CR_RE | RTW_CR_TE, 0);
2887 	RTW_WRITE8(regs, RTW_TPPOLL, RTW_TPPOLL_SALL);
2888 
2889 	return (DDI_SUCCESS);
2890 }
2891 
2892 /*
2893  * callback functions for /get/set properties
2894  */
2895 static int
2896 rtw_m_setprop(void *arg, const char *pr_name, mac_prop_id_t wldp_pr_num,
2897     uint_t wldp_length, const void *wldp_buf)
2898 {
2899 	rtw_softc_t *rsc = (rtw_softc_t *)arg;
2900 	struct ieee80211com *ic = &rsc->sc_ic;
2901 	int err;
2902 
2903 	err = ieee80211_setprop(ic, pr_name, wldp_pr_num,
2904 	    wldp_length, wldp_buf);
2905 	if (err == ENETRESET) {
2906 		if (ic->ic_des_esslen && (rsc->sc_invalid == 0)) {
2907 			(void) rtw_init(rsc);
2908 			(void) ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
2909 		}
2910 		err = 0;
2911 	}
2912 	return (err);
2913 }
2914 
2915 static int
2916 rtw_m_getprop(void *arg, const char *pr_name, mac_prop_id_t wldp_pr_num,
2917     uint_t pr_flags, uint_t wldp_length, void *wldp_buf, uint_t *perm)
2918 {
2919 	rtw_softc_t *rsc = arg;
2920 	int err;
2921 
2922 	err = ieee80211_getprop(&rsc->sc_ic, pr_name, wldp_pr_num,
2923 	    pr_flags, wldp_length, wldp_buf, perm);
2924 
2925 	return (err);
2926 }
2927 
2928 
2929 static int
2930 rtw_m_start(void *arg)
2931 {
2932 	rtw_softc_t *rsc = (rtw_softc_t *)arg;
2933 	ieee80211com_t *ic = (ieee80211com_t *)rsc;
2934 	int ret;
2935 #ifdef DEBUG
2936 	rtw_print_regs(&rsc->sc_regs, "rtw", "rtw_start");
2937 #endif
2938 
2939 	ret = rtw_init(rsc);
2940 	if (ret) {
2941 		cmn_err(CE_WARN, "rtw: failed to do rtw_init\n");
2942 		return (EIO);
2943 	}
2944 	(void) ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
2945 	return (0);
2946 }
2947 
2948 
2949 static int
2950 rtw_m_unicst(void *arg, const uint8_t *macaddr)
2951 {
2952 	rtw_softc_t *rsc = (rtw_softc_t *)arg;
2953 	ieee80211com_t *ic = (ieee80211com_t *)rsc;
2954 	struct rtw_regs *regs = &rsc->sc_regs;
2955 	uint32_t t;
2956 
2957 	mutex_enter(&rsc->sc_genlock);
2958 	bcopy(macaddr, ic->ic_macaddr, 6);
2959 	t = ((*macaddr)<<24) | ((*(macaddr + 1))<<16) |
2960 	    ((*(macaddr + 2))<<8) | (*(macaddr + 3));
2961 	RTW_WRITE(regs, RTW_IDR0, ntohl(t));
2962 	t = ((*(macaddr + 4))<<24) | ((*(macaddr + 5))<<16);
2963 	RTW_WRITE(regs, RTW_IDR1, ntohl(t));
2964 	mutex_exit(&rsc->sc_genlock);
2965 	return (0);
2966 }
2967 
2968 static int
2969 rtw_m_promisc(void *arg, boolean_t on)
2970 {
2971 	rtw_softc_t *rsc = (rtw_softc_t *)arg;
2972 	struct rtw_regs *regs = &rsc->sc_regs;
2973 
2974 	mutex_enter(&rsc->sc_genlock);
2975 
2976 	if (on)
2977 		rsc->sc_rcr |= RTW_RCR_PROMIC;
2978 	else
2979 		rsc->sc_rcr &= ~RTW_RCR_PROMIC;
2980 
2981 	RTW_WRITE(regs, RTW_RCR, rsc->sc_rcr);
2982 
2983 	mutex_exit(&rsc->sc_genlock);
2984 	return (0);
2985 }
2986 
2987 static int
2988 rtw_m_multicst(void *arg, boolean_t add, const uint8_t *macaddr)
2989 {
2990 	rtw_softc_t *rsc = (rtw_softc_t *)arg;
2991 	struct rtw_regs *regs = &rsc->sc_regs;
2992 	uint32_t t;
2993 
2994 	mutex_enter(&rsc->sc_genlock);
2995 	if (add) {
2996 		rsc->sc_rcr |= RTW_RCR_AM;
2997 		t = ((*macaddr)<<24) | ((*(macaddr + 1))<<16) |
2998 		    ((*(macaddr + 2))<<8) | (*(macaddr + 3));
2999 		RTW_WRITE(regs, RTW_MAR0, ntohl(t));
3000 		t = ((*(macaddr + 4))<<24) | ((*(macaddr + 5))<<16);
3001 		RTW_WRITE(regs, RTW_MAR1, ntohl(t));
3002 		RTW_WRITE(regs, RTW_RCR, rsc->sc_rcr);
3003 		RTW_SYNC(regs, RTW_MAR0, RTW_RCR);
3004 	} else {
3005 		rsc->sc_rcr &= ~RTW_RCR_AM;
3006 		RTW_WRITE(regs, RTW_MAR0, 0);
3007 		RTW_WRITE(regs, RTW_MAR1, 0);
3008 		RTW_WRITE(regs, RTW_RCR, rsc->sc_rcr);
3009 		RTW_SYNC(regs, RTW_MAR0, RTW_RCR);
3010 	}
3011 	mutex_exit(&rsc->sc_genlock);
3012 	return (0);
3013 }
3014 
3015 static void
3016 rtw_m_ioctl(void* arg, queue_t *wq, mblk_t *mp)
3017 {
3018 	rtw_softc_t *rsc = arg;
3019 	struct ieee80211com *ic = &rsc->sc_ic;
3020 	int err;
3021 
3022 	err = ieee80211_ioctl(ic, wq, mp);
3023 	if (err == ENETRESET) {
3024 		if (ic->ic_des_esslen && (rsc->sc_invalid == 0)) {
3025 			(void) rtw_init(rsc);
3026 			(void) ieee80211_new_state(ic,
3027 			    IEEE80211_S_SCAN, -1);
3028 		}
3029 	}
3030 }
3031 
3032 static int
3033 rtw_m_stat(void *arg, uint_t stat, uint64_t *val)
3034 {
3035 	rtw_softc_t *rsc = (rtw_softc_t *)arg;
3036 	ieee80211com_t *ic = &rsc->sc_ic;
3037 	struct ieee80211_node *in = 0;
3038 	struct ieee80211_rateset *rs = 0;
3039 
3040 	mutex_enter(&rsc->sc_genlock);
3041 	switch (stat) {
3042 	case MAC_STAT_IFSPEED:
3043 		in = ic->ic_bss;
3044 		rs = &in->in_rates;
3045 		*val = ((ic->ic_fixed_rate == IEEE80211_FIXED_RATE_NONE) ?
3046 		    (rs->ir_rates[in->in_txrate] & IEEE80211_RATE_VAL)
3047 		    : ic->ic_fixed_rate) / 2 * 1000000;
3048 		break;
3049 	case MAC_STAT_NOXMTBUF:
3050 		*val = rsc->sc_noxmtbuf;
3051 		break;
3052 	case MAC_STAT_NORCVBUF:
3053 		*val = rsc->sc_norcvbuf;
3054 		break;
3055 	case MAC_STAT_RBYTES:
3056 		*val = rsc->sc_bytercv64;
3057 		break;
3058 	case MAC_STAT_IPACKETS:
3059 		*val = rsc->sc_pktrcv64;
3060 		break;
3061 	case MAC_STAT_OBYTES:
3062 		*val = rsc->sc_bytexmt64;
3063 		break;
3064 	case MAC_STAT_OPACKETS:
3065 		*val = rsc->sc_pktxmt64;
3066 		break;
3067 	case WIFI_STAT_TX_RETRANS:
3068 		*val = rsc->sc_xmtretry;
3069 		break;
3070 	case WIFI_STAT_TX_FRAGS:
3071 	case WIFI_STAT_MCAST_TX:
3072 	case WIFI_STAT_RTS_SUCCESS:
3073 	case WIFI_STAT_RTS_FAILURE:
3074 	case WIFI_STAT_ACK_FAILURE:
3075 	case WIFI_STAT_RX_FRAGS:
3076 	case WIFI_STAT_MCAST_RX:
3077 	case WIFI_STAT_RX_DUPS:
3078 		mutex_exit(&rsc->sc_genlock);
3079 		return (ieee80211_stat(ic, stat, val));
3080 	default:
3081 		*val = 0;
3082 		break;
3083 	}
3084 	mutex_exit(&rsc->sc_genlock);
3085 
3086 	return (0);
3087 }
3088 
3089 
3090 static void
3091 rtw_mutex_destroy(rtw_softc_t *rsc)
3092 {
3093 	int i;
3094 
3095 	mutex_destroy(&rsc->rxbuf_lock);
3096 	mutex_destroy(&rsc->sc_txlock);
3097 	for (i = 0; i < RTW_NTXPRI; i++) {
3098 		mutex_destroy(&rsc->sc_txq[RTW_NTXPRI - 1 - i].txbuf_lock);
3099 	}
3100 	mutex_destroy(&rsc->sc_genlock);
3101 }
3102 
3103 static int
3104 rtw_attach(dev_info_t *devinfo, ddi_attach_cmd_t cmd)
3105 {
3106 	rtw_softc_t *rsc;
3107 	ieee80211com_t *ic;
3108 	uint8_t csz;
3109 	uint32_t i;
3110 	uint16_t vendor_id, device_id, command;
3111 	int32_t err;
3112 	char strbuf[32];
3113 	wifi_data_t wd = { 0 };
3114 	mac_register_t *macp;
3115 	int instance = ddi_get_instance(devinfo);
3116 
3117 	switch (cmd) {
3118 	case DDI_ATTACH:
3119 		break;
3120 	case DDI_RESUME:
3121 		rsc = ddi_get_soft_state(rtw_soft_state_p,
3122 		    ddi_get_instance(devinfo));
3123 		ASSERT(rsc != NULL);
3124 		mutex_enter(&rsc->sc_genlock);
3125 		rsc->sc_flags &= ~RTW_F_SUSPEND;
3126 		mutex_exit(&rsc->sc_genlock);
3127 		if ((rsc->sc_flags & RTW_F_PLUMBED)) {
3128 			err = rtw_init(rsc);
3129 			if (err == 0) {
3130 				mutex_enter(&rsc->sc_genlock);
3131 				rsc->sc_flags &= ~RTW_F_PLUMBED;
3132 				mutex_exit(&rsc->sc_genlock);
3133 			}
3134 		}
3135 		return (DDI_SUCCESS);
3136 	default:
3137 		return (DDI_FAILURE);
3138 	}
3139 
3140 	if (ddi_soft_state_zalloc(rtw_soft_state_p,
3141 	    ddi_get_instance(devinfo)) != DDI_SUCCESS) {
3142 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: rtw_attach(): "
3143 		    "Unable to alloc softstate\n");
3144 		return (DDI_FAILURE);
3145 	}
3146 
3147 	rsc = ddi_get_soft_state(rtw_soft_state_p, ddi_get_instance(devinfo));
3148 	ic = &rsc->sc_ic;
3149 	rsc->sc_dev = devinfo;
3150 
3151 	err = ddi_regs_map_setup(devinfo, 0, (caddr_t *)&rsc->sc_cfg_base, 0, 0,
3152 	    &rtw_reg_accattr, &rsc->sc_cfg_handle);
3153 	if (err != DDI_SUCCESS) {
3154 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: rtw_attach(): "
3155 		    "ddi_regs_map_setup() failed");
3156 		goto attach_fail0;
3157 	}
3158 	csz = ddi_get8(rsc->sc_cfg_handle,
3159 	    (uint8_t *)(rsc->sc_cfg_base + PCI_CONF_CACHE_LINESZ));
3160 	if (!csz)
3161 		csz = 16;
3162 	rsc->sc_cachelsz = csz << 2;
3163 	vendor_id = ddi_get16(rsc->sc_cfg_handle,
3164 	    (uint16_t *)((uintptr_t)rsc->sc_cfg_base + PCI_CONF_VENID));
3165 	device_id = ddi_get16(rsc->sc_cfg_handle,
3166 	    (uint16_t *)((uintptr_t)rsc->sc_cfg_base + PCI_CONF_DEVID));
3167 	RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: rtw_attach(): vendor 0x%x, "
3168 	    "device id 0x%x, cache size %d\n", vendor_id, device_id, csz);
3169 
3170 	/*
3171 	 * Enable response to memory space accesses,
3172 	 * and enabe bus master.
3173 	 */
3174 	command = PCI_COMM_MAE | PCI_COMM_ME;
3175 	ddi_put16(rsc->sc_cfg_handle,
3176 	    (uint16_t *)((uintptr_t)rsc->sc_cfg_base + PCI_CONF_COMM), command);
3177 	RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: rtw_attach(): "
3178 	    "set command reg to 0x%x \n", command);
3179 
3180 	ddi_put8(rsc->sc_cfg_handle,
3181 	    (uint8_t *)(rsc->sc_cfg_base + PCI_CONF_LATENCY_TIMER), 0xa8);
3182 
3183 	ddi_regs_map_free(&rsc->sc_cfg_handle);
3184 
3185 	err = ddi_regs_map_setup(devinfo, 2, (caddr_t *)&rsc->sc_regs.r_base,
3186 	    0, 0, &rtw_reg_accattr, &rsc->sc_regs.r_handle);
3187 	if (err != DDI_SUCCESS) {
3188 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: rtw_attach(): "
3189 		    "ddi_regs_map_setup() failed");
3190 		goto attach_fail0;
3191 	}
3192 	RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: r_base=%x, r_handle=%x\n",
3193 	    rsc->sc_regs.r_base, rsc->sc_regs.r_handle);
3194 
3195 	err = rtw_dma_init(devinfo, rsc);
3196 	if (err != DDI_SUCCESS) {
3197 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: rtw_attach(): "
3198 		    "failed to init dma: %d\n", err);
3199 		goto attach_fail1;
3200 	}
3201 
3202 	/*
3203 	 * Stop the transmit and receive processes. First stop DMA,
3204 	 * then disable receiver and transmitter.
3205 	 */
3206 	RTW_WRITE8(&rsc->sc_regs, RTW_TPPOLL, RTW_TPPOLL_SALL);
3207 	rtw_io_enable(rsc, RTW_CR_RE | RTW_CR_TE, 0);
3208 
3209 	/* Reset the chip to a known state. */
3210 	if (rtw_reset(rsc) != 0) {
3211 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: rtw_attach(): "
3212 		    "failed to reset\n");
3213 		goto attach_fail2;
3214 	}
3215 	rsc->sc_rcr = RTW_READ(&rsc->sc_regs, RTW_RCR);
3216 
3217 	if ((rsc->sc_rcr & RTW_RCR_9356SEL) != 0)
3218 		rsc->sc_flags |= RTW_F_9356SROM;
3219 
3220 	if (rtw_srom_read(&rsc->sc_regs, rsc->sc_flags, &rsc->sc_srom,
3221 	    "rtw") != 0) {
3222 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: rtw_attach(): "
3223 		    "failed to read srom\n");
3224 		goto attach_fail2;
3225 	}
3226 
3227 	if (rtw_srom_parse(&rsc->sc_srom, &rsc->sc_flags, &rsc->sc_csthr,
3228 	    &rsc->sc_rfchipid, &rsc->sc_rcr, &rsc->sc_locale,
3229 	    "rtw") != 0) {
3230 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw_attach():"
3231 		    " malformed serial ROM\n");
3232 		goto attach_fail3;
3233 	}
3234 
3235 	RTW_DPRINTF(RTW_DEBUG_PHY, "rtw: %s PHY\n",
3236 	    ((rsc->sc_flags & RTW_F_DIGPHY) != 0) ? "digital" : "analog");
3237 
3238 
3239 	rsc->sc_rf = rtw_rf_attach(rsc, rsc->sc_rfchipid,
3240 	    rsc->sc_flags & RTW_F_DIGPHY);
3241 
3242 	if (rsc->sc_rf == NULL) {
3243 		cmn_err(CE_WARN, "rtw: rtw_attach(): could not attach RF\n");
3244 		goto attach_fail3;
3245 	}
3246 	rsc->sc_phydelay = rtw_check_phydelay(&rsc->sc_regs, rsc->sc_rcr);
3247 
3248 	RTW_DPRINTF(RTW_DEBUG_ATTACH,
3249 	    "rtw: PHY delay %d\n", rsc->sc_phydelay);
3250 
3251 	if (rsc->sc_locale == RTW_LOCALE_UNKNOWN)
3252 		rtw_identify_country(&rsc->sc_regs, &rsc->sc_locale,
3253 		    "rtw");
3254 
3255 	rtw_init_channels(rsc->sc_locale, &rsc->sc_ic.ic_sup_channels,
3256 	    "rtw");
3257 
3258 	rtw_set80211props(ic);
3259 
3260 	if (rtw_identify_sta(&rsc->sc_regs, ic->ic_macaddr,
3261 	    "rtw") != 0)
3262 		goto attach_fail4;
3263 
3264 	ic->ic_xmit = rtw_send;
3265 	ieee80211_attach(ic);
3266 
3267 	rsc->sc_newstate = ic->ic_newstate;
3268 	ic->ic_newstate = rtw_new_state;
3269 	ieee80211_media_init(ic);
3270 	ic->ic_def_txkey = 0;
3271 
3272 	if (ddi_get_iblock_cookie(devinfo, 0, &(rsc->sc_iblock))
3273 	    != DDI_SUCCESS) {
3274 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: rtw_attach(): "
3275 		    "Can not get iblock cookie for INT\n");
3276 		goto attach_fail5;
3277 	}
3278 
3279 	mutex_init(&rsc->sc_genlock, NULL, MUTEX_DRIVER, rsc->sc_iblock);
3280 	for (i = 0; i < RTW_NTXPRI; i++) {
3281 		mutex_init(&rsc->sc_txq[i].txbuf_lock, NULL, MUTEX_DRIVER,
3282 		    rsc->sc_iblock);
3283 	}
3284 	mutex_init(&rsc->rxbuf_lock, NULL, MUTEX_DRIVER, rsc->sc_iblock);
3285 	mutex_init(&rsc->sc_txlock, NULL, MUTEX_DRIVER, rsc->sc_iblock);
3286 
3287 	if (ddi_add_intr(devinfo, 0, &rsc->sc_iblock, NULL, rtw_intr,
3288 	    (caddr_t)(rsc)) != DDI_SUCCESS) {
3289 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: rtw_attach(): "
3290 		    "Can not add intr for rtw driver\n");
3291 		goto attach_fail7;
3292 	}
3293 
3294 	/*
3295 	 * Provide initial settings for the WiFi plugin; whenever this
3296 	 * information changes, we need to call mac_plugindata_update()
3297 	 */
3298 	wd.wd_opmode = ic->ic_opmode;
3299 	wd.wd_secalloc = WIFI_SEC_NONE;
3300 	IEEE80211_ADDR_COPY(wd.wd_bssid, ic->ic_bss->in_bssid);
3301 
3302 	if ((macp = mac_alloc(MAC_VERSION)) == NULL) {
3303 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: rtw_attach(): "
3304 		    "MAC version mismatch\n");
3305 		goto attach_fail8;
3306 	}
3307 
3308 	macp->m_type_ident	= MAC_PLUGIN_IDENT_WIFI;
3309 	macp->m_driver		= rsc;
3310 	macp->m_dip		= devinfo;
3311 	macp->m_src_addr	= ic->ic_macaddr;
3312 	macp->m_callbacks	= &rtw_m_callbacks;
3313 	macp->m_min_sdu		= 0;
3314 	macp->m_max_sdu		= IEEE80211_MTU;
3315 	macp->m_pdata		= &wd;
3316 	macp->m_pdata_size	= sizeof (wd);
3317 
3318 	err = mac_register(macp, &ic->ic_mach);
3319 	mac_free(macp);
3320 	if (err != 0) {
3321 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "rtw: rtw_attach(): "
3322 		    "mac_register err %x\n", err);
3323 		goto attach_fail8;
3324 	}
3325 
3326 	/* Create minor node of type DDI_NT_NET_WIFI */
3327 	(void) snprintf(strbuf, sizeof (strbuf), "%s%d",
3328 	    "rtw", instance);
3329 	err = ddi_create_minor_node(devinfo, strbuf, S_IFCHR,
3330 	    instance + 1, DDI_NT_NET_WIFI, 0);
3331 	if (err != DDI_SUCCESS) {
3332 		RTW_DPRINTF(RTW_DEBUG_ATTACH, "WARN: rtw: rtw_attach(): "
3333 		    "Create minor node failed - %d\n", err);
3334 		goto attach_fail9;
3335 	}
3336 	mac_link_update(ic->ic_mach, LINK_STATE_DOWN);
3337 	rsc->sc_flags |= RTW_F_ATTACHED;
3338 	rsc->sc_need_reschedule = 0;
3339 	rsc->sc_invalid = 1;
3340 	return (DDI_SUCCESS);
3341 attach_fail9:
3342 	(void) mac_disable(ic->ic_mach);
3343 	(void) mac_unregister(ic->ic_mach);
3344 attach_fail8:
3345 	ddi_remove_intr(devinfo, 0, rsc->sc_iblock);
3346 attach_fail7:
3347 attach_fail6:
3348 	rtw_mutex_destroy(rsc);
3349 attach_fail5:
3350 	ieee80211_detach(ic);
3351 attach_fail4:
3352 	rtw_rf_destroy(rsc->sc_rf);
3353 attach_fail3:
3354 	rtw_srom_free(&rsc->sc_srom);
3355 attach_fail2:
3356 	rtw_dma_free(rsc);
3357 attach_fail1:
3358 	ddi_regs_map_free(&rsc->sc_regs.r_handle);
3359 attach_fail0:
3360 	ddi_soft_state_free(rtw_soft_state_p, ddi_get_instance(devinfo));
3361 	return (DDI_FAILURE);
3362 }
3363 
3364 static int32_t
3365 rtw_detach(dev_info_t *devinfo, ddi_detach_cmd_t cmd)
3366 {
3367 	rtw_softc_t *rsc;
3368 
3369 	rsc = ddi_get_soft_state(rtw_soft_state_p, ddi_get_instance(devinfo));
3370 	ASSERT(rsc != NULL);
3371 
3372 	switch (cmd) {
3373 	case DDI_DETACH:
3374 		break;
3375 	case DDI_SUSPEND:
3376 		ieee80211_new_state(&rsc->sc_ic, IEEE80211_S_INIT, -1);
3377 		mutex_enter(&rsc->sc_genlock);
3378 		rsc->sc_flags |= RTW_F_SUSPEND;
3379 		mutex_exit(&rsc->sc_genlock);
3380 		if (rsc->sc_invalid == 0) {
3381 			rtw_stop(rsc);
3382 			mutex_enter(&rsc->sc_genlock);
3383 			rsc->sc_flags |= RTW_F_PLUMBED;
3384 			mutex_exit(&rsc->sc_genlock);
3385 		}
3386 		return (DDI_SUCCESS);
3387 	default:
3388 		return (DDI_FAILURE);
3389 	}
3390 	if (!(rsc->sc_flags & RTW_F_ATTACHED))
3391 		return (DDI_FAILURE);
3392 
3393 	if (mac_disable(rsc->sc_ic.ic_mach) != 0)
3394 		return (DDI_FAILURE);
3395 
3396 	/* free intterrupt resources */
3397 	ddi_remove_intr(devinfo, 0, rsc->sc_iblock);
3398 
3399 	rtw_mutex_destroy(rsc);
3400 	ieee80211_detach((ieee80211com_t *)rsc);
3401 	/*
3402 	 * Unregister from the MAC layer subsystem
3403 	 */
3404 	(void) mac_unregister(rsc->sc_ic.ic_mach);
3405 
3406 	rtw_rf_destroy(rsc->sc_rf);
3407 	rtw_srom_free(&rsc->sc_srom);
3408 	rtw_dma_free(rsc);
3409 	ddi_remove_minor_node(devinfo, NULL);
3410 	ddi_regs_map_free(&rsc->sc_regs.r_handle);
3411 
3412 	ddi_soft_state_free(rtw_soft_state_p, ddi_get_instance(devinfo));
3413 
3414 	return (DDI_SUCCESS);
3415 }
3416