rtw.c revision 1.1.2.4 1 1.1.2.4 skrll /* $NetBSD: rtw.c,v 1.1.2.4 2004/12/18 09:31:56 skrll Exp $ */
2 1.1.2.2 skrll /*-
3 1.1.2.2 skrll * Copyright (c) 2004, 2005 David Young. All rights reserved.
4 1.1.2.2 skrll *
5 1.1.2.2 skrll * Programmed for NetBSD by David Young.
6 1.1.2.2 skrll *
7 1.1.2.2 skrll * Redistribution and use in source and binary forms, with or without
8 1.1.2.2 skrll * modification, are permitted provided that the following conditions
9 1.1.2.2 skrll * are met:
10 1.1.2.2 skrll * 1. Redistributions of source code must retain the above copyright
11 1.1.2.2 skrll * notice, this list of conditions and the following disclaimer.
12 1.1.2.2 skrll * 2. Redistributions in binary form must reproduce the above copyright
13 1.1.2.2 skrll * notice, this list of conditions and the following disclaimer in the
14 1.1.2.2 skrll * documentation and/or other materials provided with the distribution.
15 1.1.2.2 skrll * 3. The name of David Young may not be used to endorse or promote
16 1.1.2.2 skrll * products derived from this software without specific prior
17 1.1.2.2 skrll * written permission.
18 1.1.2.2 skrll *
19 1.1.2.2 skrll * THIS SOFTWARE IS PROVIDED BY David Young ``AS IS'' AND ANY
20 1.1.2.2 skrll * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
21 1.1.2.2 skrll * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
22 1.1.2.2 skrll * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL David
23 1.1.2.2 skrll * Young BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
24 1.1.2.2 skrll * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
25 1.1.2.2 skrll * TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 1.1.2.2 skrll * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
27 1.1.2.2 skrll * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
28 1.1.2.2 skrll * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29 1.1.2.2 skrll * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
30 1.1.2.2 skrll * OF SUCH DAMAGE.
31 1.1.2.2 skrll */
32 1.1.2.2 skrll /*
33 1.1.2.2 skrll * Device driver for the Realtek RTL8180 802.11 MAC/BBP.
34 1.1.2.2 skrll */
35 1.1.2.2 skrll
36 1.1.2.2 skrll #include <sys/cdefs.h>
37 1.1.2.4 skrll __KERNEL_RCSID(0, "$NetBSD: rtw.c,v 1.1.2.4 2004/12/18 09:31:56 skrll Exp $");
38 1.1.2.2 skrll
39 1.1.2.2 skrll #include "bpfilter.h"
40 1.1.2.2 skrll
41 1.1.2.2 skrll #include <sys/param.h>
42 1.1.2.4 skrll #include <sys/sysctl.h>
43 1.1.2.2 skrll #include <sys/systm.h>
44 1.1.2.2 skrll #include <sys/callout.h>
45 1.1.2.2 skrll #include <sys/mbuf.h>
46 1.1.2.2 skrll #include <sys/malloc.h>
47 1.1.2.2 skrll #include <sys/kernel.h>
48 1.1.2.2 skrll #if 0
49 1.1.2.2 skrll #include <sys/socket.h>
50 1.1.2.2 skrll #include <sys/ioctl.h>
51 1.1.2.2 skrll #include <sys/errno.h>
52 1.1.2.2 skrll #include <sys/device.h>
53 1.1.2.2 skrll #endif
54 1.1.2.2 skrll #include <sys/time.h>
55 1.1.2.2 skrll #include <sys/types.h>
56 1.1.2.2 skrll
57 1.1.2.2 skrll #include <machine/endian.h>
58 1.1.2.2 skrll #include <machine/bus.h>
59 1.1.2.2 skrll #include <machine/intr.h> /* splnet */
60 1.1.2.2 skrll
61 1.1.2.2 skrll #include <uvm/uvm_extern.h>
62 1.1.2.2 skrll
63 1.1.2.2 skrll #include <net/if.h>
64 1.1.2.2 skrll #include <net/if_media.h>
65 1.1.2.2 skrll #include <net/if_ether.h>
66 1.1.2.2 skrll
67 1.1.2.2 skrll #include <net80211/ieee80211_var.h>
68 1.1.2.2 skrll #include <net80211/ieee80211_compat.h>
69 1.1.2.2 skrll #include <net80211/ieee80211_radiotap.h>
70 1.1.2.2 skrll
71 1.1.2.2 skrll #if NBPFILTER > 0
72 1.1.2.2 skrll #include <net/bpf.h>
73 1.1.2.2 skrll #endif
74 1.1.2.2 skrll
75 1.1.2.2 skrll #include <dev/ic/rtwreg.h>
76 1.1.2.2 skrll #include <dev/ic/rtwvar.h>
77 1.1.2.2 skrll #include <dev/ic/rtwphyio.h>
78 1.1.2.2 skrll #include <dev/ic/rtwphy.h>
79 1.1.2.2 skrll
80 1.1.2.2 skrll #include <dev/ic/smc93cx6var.h>
81 1.1.2.2 skrll
82 1.1.2.2 skrll #define KASSERT2(__cond, __msg) \
83 1.1.2.2 skrll do { \
84 1.1.2.2 skrll if (!(__cond)) \
85 1.1.2.2 skrll panic __msg ; \
86 1.1.2.2 skrll } while (0)
87 1.1.2.2 skrll
88 1.1.2.4 skrll int rtw_rfprog_fallback = 0;
89 1.1.2.4 skrll int rtw_host_rfio = 0;
90 1.1.2.4 skrll int rtw_flush_rfio = 1;
91 1.1.2.4 skrll int rtw_rfio_delay = 0;
92 1.1.2.4 skrll
93 1.1.2.2 skrll #ifdef RTW_DEBUG
94 1.1.2.2 skrll int rtw_debug = 2;
95 1.1.2.2 skrll #endif /* RTW_DEBUG */
96 1.1.2.2 skrll
97 1.1.2.2 skrll #define NEXT_ATTACH_STATE(sc, state) do { \
98 1.1.2.2 skrll DPRINTF(sc, ("%s: attach state %s\n", __func__, #state)); \
99 1.1.2.2 skrll sc->sc_attach_state = state; \
100 1.1.2.2 skrll } while (0)
101 1.1.2.2 skrll
102 1.1.2.2 skrll int rtw_dwelltime = 1000; /* milliseconds */
103 1.1.2.2 skrll
104 1.1.2.4 skrll static int rtw_sysctl_verify_rfio(SYSCTLFN_PROTO);
105 1.1.2.4 skrll static int rtw_sysctl_verify_rfio_delay(SYSCTLFN_PROTO);
106 1.1.2.4 skrll static int rtw_sysctl_verify_rfprog(SYSCTLFN_PROTO);
107 1.1.2.2 skrll #ifdef RTW_DEBUG
108 1.1.2.4 skrll static int rtw_sysctl_verify_debug(SYSCTLFN_PROTO);
109 1.1.2.4 skrll #endif /* RTW_DEBUG */
110 1.1.2.4 skrll
111 1.1.2.4 skrll /*
112 1.1.2.4 skrll * Setup sysctl(3) MIB, hw.rtw.*
113 1.1.2.4 skrll *
114 1.1.2.4 skrll * TBD condition CTLFLAG_PERMANENT on being an LKM or not
115 1.1.2.4 skrll */
116 1.1.2.4 skrll SYSCTL_SETUP(sysctl_rtw, "sysctl rtw(4) subtree setup")
117 1.1.2.4 skrll {
118 1.1.2.4 skrll int rc;
119 1.1.2.4 skrll struct sysctlnode *cnode, *rnode;
120 1.1.2.4 skrll
121 1.1.2.4 skrll if ((rc = sysctl_createv(clog, 0, NULL, &rnode,
122 1.1.2.4 skrll CTLFLAG_PERMANENT, CTLTYPE_NODE, "hw", NULL,
123 1.1.2.4 skrll NULL, 0, NULL, 0, CTL_HW, CTL_EOL)) != 0)
124 1.1.2.4 skrll goto err;
125 1.1.2.4 skrll
126 1.1.2.4 skrll if ((rc = sysctl_createv(clog, 0, &rnode, &rnode,
127 1.1.2.4 skrll CTLFLAG_PERMANENT, CTLTYPE_NODE, "rtw",
128 1.1.2.4 skrll "Realtek RTL818x 802.11 controls",
129 1.1.2.4 skrll NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL)) != 0)
130 1.1.2.4 skrll goto err;
131 1.1.2.4 skrll
132 1.1.2.4 skrll #ifdef RTW_DEBUG
133 1.1.2.4 skrll /* control debugging printfs */
134 1.1.2.4 skrll if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
135 1.1.2.4 skrll CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
136 1.1.2.4 skrll "debug", SYSCTL_DESCR("Enable RTL818x debugging output"),
137 1.1.2.4 skrll rtw_sysctl_verify_debug, 0, &rtw_debug, 0,
138 1.1.2.4 skrll CTL_CREATE, CTL_EOL)) != 0)
139 1.1.2.4 skrll goto err;
140 1.1.2.4 skrll #endif /* RTW_DEBUG */
141 1.1.2.4 skrll /* set fallback RF programming method */
142 1.1.2.4 skrll if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
143 1.1.2.4 skrll CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
144 1.1.2.4 skrll "rfprog_fallback",
145 1.1.2.4 skrll SYSCTL_DESCR("Set fallback RF programming method"),
146 1.1.2.4 skrll rtw_sysctl_verify_rfprog, 0, &rtw_rfprog_fallback, 0,
147 1.1.2.4 skrll CTL_CREATE, CTL_EOL)) != 0)
148 1.1.2.4 skrll goto err;
149 1.1.2.4 skrll
150 1.1.2.4 skrll /* force host to flush I/O by reading RTW_PHYADDR */
151 1.1.2.4 skrll if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
152 1.1.2.4 skrll CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
153 1.1.2.4 skrll "flush_rfio", SYSCTL_DESCR("Enable RF I/O flushing"),
154 1.1.2.4 skrll rtw_sysctl_verify_rfio, 0, &rtw_flush_rfio, 0,
155 1.1.2.4 skrll CTL_CREATE, CTL_EOL)) != 0)
156 1.1.2.4 skrll goto err;
157 1.1.2.4 skrll
158 1.1.2.4 skrll /* force host to control RF I/O bus */
159 1.1.2.4 skrll if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
160 1.1.2.4 skrll CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
161 1.1.2.4 skrll "host_rfio", SYSCTL_DESCR("Enable host control of RF I/O"),
162 1.1.2.4 skrll rtw_sysctl_verify_rfio, 0, &rtw_host_rfio, 0,
163 1.1.2.4 skrll CTL_CREATE, CTL_EOL)) != 0)
164 1.1.2.4 skrll goto err;
165 1.1.2.4 skrll
166 1.1.2.4 skrll /* control RF I/O delay */
167 1.1.2.4 skrll if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
168 1.1.2.4 skrll CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
169 1.1.2.4 skrll "rfio_delay", SYSCTL_DESCR("Set RF I/O delay"),
170 1.1.2.4 skrll rtw_sysctl_verify_rfio_delay, 0, &rtw_rfio_delay, 0,
171 1.1.2.4 skrll CTL_CREATE, CTL_EOL)) != 0)
172 1.1.2.4 skrll goto err;
173 1.1.2.4 skrll
174 1.1.2.4 skrll return;
175 1.1.2.4 skrll err:
176 1.1.2.4 skrll printf("%s: sysctl_createv failed (rc = %d)\n", __func__, rc);
177 1.1.2.4 skrll }
178 1.1.2.4 skrll
179 1.1.2.4 skrll static int
180 1.1.2.4 skrll rtw_sysctl_verify(SYSCTLFN_ARGS, int lower, int upper)
181 1.1.2.4 skrll {
182 1.1.2.4 skrll int error, t;
183 1.1.2.4 skrll struct sysctlnode node;
184 1.1.2.4 skrll
185 1.1.2.4 skrll node = *rnode;
186 1.1.2.4 skrll t = *(int*)rnode->sysctl_data;
187 1.1.2.4 skrll node.sysctl_data = &t;
188 1.1.2.4 skrll error = sysctl_lookup(SYSCTLFN_CALL(&node));
189 1.1.2.4 skrll if (error || newp == NULL)
190 1.1.2.4 skrll return (error);
191 1.1.2.4 skrll
192 1.1.2.4 skrll if (t < lower || t > upper)
193 1.1.2.4 skrll return (EINVAL);
194 1.1.2.4 skrll
195 1.1.2.4 skrll *(int*)rnode->sysctl_data = t;
196 1.1.2.4 skrll
197 1.1.2.4 skrll return (0);
198 1.1.2.4 skrll }
199 1.1.2.4 skrll
200 1.1.2.4 skrll static int
201 1.1.2.4 skrll rtw_sysctl_verify_rfio_delay(SYSCTLFN_ARGS)
202 1.1.2.4 skrll {
203 1.1.2.4 skrll return rtw_sysctl_verify(SYSCTLFN_CALL(rnode), 0, 1000000);
204 1.1.2.4 skrll }
205 1.1.2.4 skrll
206 1.1.2.4 skrll static int
207 1.1.2.4 skrll rtw_sysctl_verify_rfprog(SYSCTLFN_ARGS)
208 1.1.2.4 skrll {
209 1.1.2.4 skrll return rtw_sysctl_verify(SYSCTLFN_CALL(rnode), 0,
210 1.1.2.4 skrll MASK_AND_RSHIFT(RTW_CONFIG4_RFTYPE_MASK, RTW_CONFIG4_RFTYPE_MASK));
211 1.1.2.4 skrll }
212 1.1.2.4 skrll
213 1.1.2.4 skrll static int
214 1.1.2.4 skrll rtw_sysctl_verify_rfio(SYSCTLFN_ARGS)
215 1.1.2.4 skrll {
216 1.1.2.4 skrll return rtw_sysctl_verify(SYSCTLFN_CALL(rnode), 0, 1);
217 1.1.2.4 skrll }
218 1.1.2.4 skrll
219 1.1.2.4 skrll #ifdef RTW_DEBUG
220 1.1.2.4 skrll static int
221 1.1.2.4 skrll rtw_sysctl_verify_debug(SYSCTLFN_ARGS)
222 1.1.2.4 skrll {
223 1.1.2.4 skrll return rtw_sysctl_verify(SYSCTLFN_CALL(rnode), 0, 2);
224 1.1.2.4 skrll }
225 1.1.2.4 skrll
226 1.1.2.2 skrll static void
227 1.1.2.2 skrll rtw_print_regs(struct rtw_regs *regs, const char *dvname, const char *where)
228 1.1.2.2 skrll {
229 1.1.2.2 skrll #define PRINTREG32(sc, reg) \
230 1.1.2.2 skrll RTW_DPRINTF2(("%s: reg[ " #reg " / %03x ] = %08x\n", \
231 1.1.2.2 skrll dvname, reg, RTW_READ(regs, reg)))
232 1.1.2.2 skrll
233 1.1.2.2 skrll #define PRINTREG16(sc, reg) \
234 1.1.2.2 skrll RTW_DPRINTF2(("%s: reg[ " #reg " / %03x ] = %04x\n", \
235 1.1.2.2 skrll dvname, reg, RTW_READ16(regs, reg)))
236 1.1.2.2 skrll
237 1.1.2.2 skrll #define PRINTREG8(sc, reg) \
238 1.1.2.2 skrll RTW_DPRINTF2(("%s: reg[ " #reg " / %03x ] = %02x\n", \
239 1.1.2.2 skrll dvname, reg, RTW_READ8(regs, reg)))
240 1.1.2.2 skrll
241 1.1.2.2 skrll RTW_DPRINTF2(("%s: %s\n", dvname, where));
242 1.1.2.2 skrll
243 1.1.2.2 skrll PRINTREG32(regs, RTW_IDR0);
244 1.1.2.2 skrll PRINTREG32(regs, RTW_IDR1);
245 1.1.2.2 skrll PRINTREG32(regs, RTW_MAR0);
246 1.1.2.2 skrll PRINTREG32(regs, RTW_MAR1);
247 1.1.2.2 skrll PRINTREG32(regs, RTW_TSFTRL);
248 1.1.2.2 skrll PRINTREG32(regs, RTW_TSFTRH);
249 1.1.2.2 skrll PRINTREG32(regs, RTW_TLPDA);
250 1.1.2.2 skrll PRINTREG32(regs, RTW_TNPDA);
251 1.1.2.2 skrll PRINTREG32(regs, RTW_THPDA);
252 1.1.2.2 skrll PRINTREG32(regs, RTW_TCR);
253 1.1.2.2 skrll PRINTREG32(regs, RTW_RCR);
254 1.1.2.2 skrll PRINTREG32(regs, RTW_TINT);
255 1.1.2.2 skrll PRINTREG32(regs, RTW_TBDA);
256 1.1.2.2 skrll PRINTREG32(regs, RTW_ANAPARM);
257 1.1.2.2 skrll PRINTREG32(regs, RTW_BB);
258 1.1.2.2 skrll PRINTREG32(regs, RTW_PHYCFG);
259 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP0L);
260 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP0H);
261 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP1L);
262 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP1H);
263 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP2LL);
264 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP2LH);
265 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP2HL);
266 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP2HH);
267 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP3LL);
268 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP3LH);
269 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP3HL);
270 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP3HH);
271 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP4LL);
272 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP4LH);
273 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP4HL);
274 1.1.2.2 skrll PRINTREG32(regs, RTW_WAKEUP4HH);
275 1.1.2.2 skrll PRINTREG32(regs, RTW_DK0);
276 1.1.2.2 skrll PRINTREG32(regs, RTW_DK1);
277 1.1.2.2 skrll PRINTREG32(regs, RTW_DK2);
278 1.1.2.2 skrll PRINTREG32(regs, RTW_DK3);
279 1.1.2.2 skrll PRINTREG32(regs, RTW_RETRYCTR);
280 1.1.2.2 skrll PRINTREG32(regs, RTW_RDSAR);
281 1.1.2.2 skrll PRINTREG32(regs, RTW_FER);
282 1.1.2.2 skrll PRINTREG32(regs, RTW_FEMR);
283 1.1.2.2 skrll PRINTREG32(regs, RTW_FPSR);
284 1.1.2.2 skrll PRINTREG32(regs, RTW_FFER);
285 1.1.2.2 skrll
286 1.1.2.2 skrll /* 16-bit registers */
287 1.1.2.2 skrll PRINTREG16(regs, RTW_BRSR);
288 1.1.2.2 skrll PRINTREG16(regs, RTW_IMR);
289 1.1.2.2 skrll PRINTREG16(regs, RTW_ISR);
290 1.1.2.2 skrll PRINTREG16(regs, RTW_BCNITV);
291 1.1.2.2 skrll PRINTREG16(regs, RTW_ATIMWND);
292 1.1.2.2 skrll PRINTREG16(regs, RTW_BINTRITV);
293 1.1.2.2 skrll PRINTREG16(regs, RTW_ATIMTRITV);
294 1.1.2.2 skrll PRINTREG16(regs, RTW_CRC16ERR);
295 1.1.2.2 skrll PRINTREG16(regs, RTW_CRC0);
296 1.1.2.2 skrll PRINTREG16(regs, RTW_CRC1);
297 1.1.2.2 skrll PRINTREG16(regs, RTW_CRC2);
298 1.1.2.2 skrll PRINTREG16(regs, RTW_CRC3);
299 1.1.2.2 skrll PRINTREG16(regs, RTW_CRC4);
300 1.1.2.2 skrll PRINTREG16(regs, RTW_CWR);
301 1.1.2.2 skrll
302 1.1.2.2 skrll /* 8-bit registers */
303 1.1.2.2 skrll PRINTREG8(regs, RTW_CR);
304 1.1.2.2 skrll PRINTREG8(regs, RTW_9346CR);
305 1.1.2.2 skrll PRINTREG8(regs, RTW_CONFIG0);
306 1.1.2.2 skrll PRINTREG8(regs, RTW_CONFIG1);
307 1.1.2.2 skrll PRINTREG8(regs, RTW_CONFIG2);
308 1.1.2.2 skrll PRINTREG8(regs, RTW_MSR);
309 1.1.2.2 skrll PRINTREG8(regs, RTW_CONFIG3);
310 1.1.2.2 skrll PRINTREG8(regs, RTW_CONFIG4);
311 1.1.2.2 skrll PRINTREG8(regs, RTW_TESTR);
312 1.1.2.2 skrll PRINTREG8(regs, RTW_PSR);
313 1.1.2.2 skrll PRINTREG8(regs, RTW_SCR);
314 1.1.2.2 skrll PRINTREG8(regs, RTW_PHYDELAY);
315 1.1.2.2 skrll PRINTREG8(regs, RTW_CRCOUNT);
316 1.1.2.2 skrll PRINTREG8(regs, RTW_PHYADDR);
317 1.1.2.2 skrll PRINTREG8(regs, RTW_PHYDATAW);
318 1.1.2.2 skrll PRINTREG8(regs, RTW_PHYDATAR);
319 1.1.2.2 skrll PRINTREG8(regs, RTW_CONFIG5);
320 1.1.2.2 skrll PRINTREG8(regs, RTW_TPPOLL);
321 1.1.2.2 skrll
322 1.1.2.2 skrll PRINTREG16(regs, RTW_BSSID16);
323 1.1.2.2 skrll PRINTREG32(regs, RTW_BSSID32);
324 1.1.2.2 skrll #undef PRINTREG32
325 1.1.2.2 skrll #undef PRINTREG16
326 1.1.2.2 skrll #undef PRINTREG8
327 1.1.2.2 skrll }
328 1.1.2.2 skrll #endif /* RTW_DEBUG */
329 1.1.2.2 skrll
330 1.1.2.2 skrll void
331 1.1.2.4 skrll rtw_continuous_tx_enable(struct rtw_softc *sc, int enable)
332 1.1.2.2 skrll {
333 1.1.2.4 skrll struct rtw_regs *regs = &sc->sc_regs;
334 1.1.2.4 skrll
335 1.1.2.2 skrll u_int32_t tcr;
336 1.1.2.2 skrll tcr = RTW_READ(regs, RTW_TCR);
337 1.1.2.2 skrll tcr &= ~RTW_TCR_LBK_MASK;
338 1.1.2.2 skrll if (enable)
339 1.1.2.2 skrll tcr |= RTW_TCR_LBK_CONT;
340 1.1.2.2 skrll else
341 1.1.2.2 skrll tcr |= RTW_TCR_LBK_NORMAL;
342 1.1.2.2 skrll RTW_WRITE(regs, RTW_TCR, tcr);
343 1.1.2.2 skrll RTW_SYNC(regs, RTW_TCR, RTW_TCR);
344 1.1.2.4 skrll rtw_set_access(sc, RTW_ACCESS_ANAPARM);
345 1.1.2.4 skrll rtw_txdac_enable(sc, !enable);
346 1.1.2.4 skrll rtw_set_access(sc, RTW_ACCESS_ANAPARM); /* XXX Voodoo from Linux. */
347 1.1.2.4 skrll rtw_set_access(sc, RTW_ACCESS_NONE);
348 1.1.2.4 skrll }
349 1.1.2.4 skrll
350 1.1.2.4 skrll static const char *
351 1.1.2.4 skrll rtw_access_string(enum rtw_access access)
352 1.1.2.4 skrll {
353 1.1.2.4 skrll switch (access) {
354 1.1.2.4 skrll case RTW_ACCESS_NONE:
355 1.1.2.4 skrll return "none";
356 1.1.2.4 skrll case RTW_ACCESS_CONFIG:
357 1.1.2.4 skrll return "config";
358 1.1.2.4 skrll case RTW_ACCESS_ANAPARM:
359 1.1.2.4 skrll return "anaparm";
360 1.1.2.4 skrll default:
361 1.1.2.4 skrll return "unknown";
362 1.1.2.2 skrll }
363 1.1.2.2 skrll }
364 1.1.2.2 skrll
365 1.1.2.4 skrll static void
366 1.1.2.4 skrll rtw_set_access1(struct rtw_regs *regs,
367 1.1.2.4 skrll enum rtw_access oaccess, enum rtw_access naccess)
368 1.1.2.4 skrll {
369 1.1.2.4 skrll KASSERT(naccess >= RTW_ACCESS_NONE && naccess <= RTW_ACCESS_ANAPARM);
370 1.1.2.4 skrll KASSERT(oaccess >= RTW_ACCESS_NONE && oaccess <= RTW_ACCESS_ANAPARM);
371 1.1.2.4 skrll
372 1.1.2.4 skrll if (naccess == oaccess)
373 1.1.2.4 skrll return;
374 1.1.2.4 skrll
375 1.1.2.4 skrll switch (naccess) {
376 1.1.2.4 skrll case RTW_ACCESS_NONE:
377 1.1.2.4 skrll switch (oaccess) {
378 1.1.2.4 skrll case RTW_ACCESS_ANAPARM:
379 1.1.2.4 skrll rtw_anaparm_enable(regs, 0);
380 1.1.2.4 skrll /*FALLTHROUGH*/
381 1.1.2.4 skrll case RTW_ACCESS_CONFIG:
382 1.1.2.4 skrll rtw_config0123_enable(regs, 0);
383 1.1.2.4 skrll /*FALLTHROUGH*/
384 1.1.2.4 skrll case RTW_ACCESS_NONE:
385 1.1.2.4 skrll break;
386 1.1.2.4 skrll }
387 1.1.2.4 skrll break;
388 1.1.2.4 skrll case RTW_ACCESS_CONFIG:
389 1.1.2.4 skrll switch (oaccess) {
390 1.1.2.4 skrll case RTW_ACCESS_NONE:
391 1.1.2.4 skrll rtw_config0123_enable(regs, 1);
392 1.1.2.4 skrll /*FALLTHROUGH*/
393 1.1.2.4 skrll case RTW_ACCESS_CONFIG:
394 1.1.2.4 skrll break;
395 1.1.2.4 skrll case RTW_ACCESS_ANAPARM:
396 1.1.2.4 skrll rtw_anaparm_enable(regs, 0);
397 1.1.2.4 skrll break;
398 1.1.2.4 skrll }
399 1.1.2.4 skrll break;
400 1.1.2.4 skrll case RTW_ACCESS_ANAPARM:
401 1.1.2.4 skrll switch (oaccess) {
402 1.1.2.4 skrll case RTW_ACCESS_NONE:
403 1.1.2.4 skrll rtw_config0123_enable(regs, 1);
404 1.1.2.4 skrll /*FALLTHROUGH*/
405 1.1.2.4 skrll case RTW_ACCESS_CONFIG:
406 1.1.2.4 skrll rtw_anaparm_enable(regs, 1);
407 1.1.2.4 skrll /*FALLTHROUGH*/
408 1.1.2.4 skrll case RTW_ACCESS_ANAPARM:
409 1.1.2.4 skrll break;
410 1.1.2.4 skrll }
411 1.1.2.4 skrll break;
412 1.1.2.4 skrll }
413 1.1.2.4 skrll }
414 1.1.2.4 skrll
415 1.1.2.4 skrll void
416 1.1.2.4 skrll rtw_set_access(struct rtw_softc *sc, enum rtw_access access)
417 1.1.2.4 skrll {
418 1.1.2.4 skrll rtw_set_access1(&sc->sc_regs, sc->sc_access, access);
419 1.1.2.4 skrll RTW_DPRINTF(("%s: access %s -> %s\n", sc->sc_dev.dv_xname,
420 1.1.2.4 skrll rtw_access_string(sc->sc_access),
421 1.1.2.4 skrll rtw_access_string(access)));
422 1.1.2.4 skrll sc->sc_access = access;
423 1.1.2.4 skrll }
424 1.1.2.4 skrll
425 1.1.2.2 skrll /*
426 1.1.2.2 skrll * Enable registers, switch register banks.
427 1.1.2.2 skrll */
428 1.1.2.2 skrll void
429 1.1.2.2 skrll rtw_config0123_enable(struct rtw_regs *regs, int enable)
430 1.1.2.2 skrll {
431 1.1.2.2 skrll u_int8_t ecr;
432 1.1.2.2 skrll ecr = RTW_READ8(regs, RTW_9346CR);
433 1.1.2.2 skrll ecr &= ~(RTW_9346CR_EEM_MASK | RTW_9346CR_EECS | RTW_9346CR_EESK);
434 1.1.2.2 skrll if (enable)
435 1.1.2.2 skrll ecr |= RTW_9346CR_EEM_CONFIG;
436 1.1.2.2 skrll else
437 1.1.2.2 skrll ecr |= RTW_9346CR_EEM_NORMAL;
438 1.1.2.2 skrll RTW_WRITE8(regs, RTW_9346CR, ecr);
439 1.1.2.2 skrll RTW_SYNC(regs, RTW_9346CR, RTW_9346CR);
440 1.1.2.2 skrll }
441 1.1.2.2 skrll
442 1.1.2.2 skrll /* requires rtw_config0123_enable(, 1) */
443 1.1.2.2 skrll void
444 1.1.2.2 skrll rtw_anaparm_enable(struct rtw_regs *regs, int enable)
445 1.1.2.2 skrll {
446 1.1.2.2 skrll u_int8_t cfg3;
447 1.1.2.2 skrll
448 1.1.2.2 skrll cfg3 = RTW_READ8(regs, RTW_CONFIG3);
449 1.1.2.4 skrll cfg3 |= RTW_CONFIG3_CLKRUNEN;
450 1.1.2.4 skrll if (enable)
451 1.1.2.4 skrll cfg3 |= RTW_CONFIG3_PARMEN;
452 1.1.2.4 skrll else
453 1.1.2.2 skrll cfg3 &= ~RTW_CONFIG3_PARMEN;
454 1.1.2.2 skrll RTW_WRITE8(regs, RTW_CONFIG3, cfg3);
455 1.1.2.2 skrll RTW_SYNC(regs, RTW_CONFIG3, RTW_CONFIG3);
456 1.1.2.2 skrll }
457 1.1.2.2 skrll
458 1.1.2.2 skrll /* requires rtw_anaparm_enable(, 1) */
459 1.1.2.2 skrll void
460 1.1.2.4 skrll rtw_txdac_enable(struct rtw_softc *sc, int enable)
461 1.1.2.2 skrll {
462 1.1.2.2 skrll u_int32_t anaparm;
463 1.1.2.4 skrll struct rtw_regs *regs = &sc->sc_regs;
464 1.1.2.2 skrll
465 1.1.2.2 skrll anaparm = RTW_READ(regs, RTW_ANAPARM);
466 1.1.2.2 skrll if (enable)
467 1.1.2.2 skrll anaparm &= ~RTW_ANAPARM_TXDACOFF;
468 1.1.2.2 skrll else
469 1.1.2.2 skrll anaparm |= RTW_ANAPARM_TXDACOFF;
470 1.1.2.2 skrll RTW_WRITE(regs, RTW_ANAPARM, anaparm);
471 1.1.2.2 skrll RTW_SYNC(regs, RTW_ANAPARM, RTW_ANAPARM);
472 1.1.2.2 skrll }
473 1.1.2.2 skrll
474 1.1.2.2 skrll static __inline int
475 1.1.2.4 skrll rtw_chip_reset1(struct rtw_regs *regs, char (*dvname)[IFNAMSIZ])
476 1.1.2.2 skrll {
477 1.1.2.2 skrll u_int8_t cr;
478 1.1.2.4 skrll int i;
479 1.1.2.2 skrll
480 1.1.2.2 skrll RTW_WRITE8(regs, RTW_CR, RTW_CR_RST);
481 1.1.2.2 skrll
482 1.1.2.2 skrll RTW_WBR(regs, RTW_CR, RTW_CR);
483 1.1.2.2 skrll
484 1.1.2.2 skrll for (i = 0; i < 10000; i++) {
485 1.1.2.2 skrll if ((cr = RTW_READ8(regs, RTW_CR) & RTW_CR_RST) == 0) {
486 1.1.2.2 skrll RTW_DPRINTF(("%s: reset in %dus\n", *dvname, i));
487 1.1.2.2 skrll return 0;
488 1.1.2.2 skrll }
489 1.1.2.2 skrll RTW_RBR(regs, RTW_CR, RTW_CR);
490 1.1.2.2 skrll DELAY(1); /* 1us */
491 1.1.2.2 skrll }
492 1.1.2.2 skrll
493 1.1.2.2 skrll printf("%s: reset failed\n", *dvname);
494 1.1.2.2 skrll return ETIMEDOUT;
495 1.1.2.2 skrll }
496 1.1.2.2 skrll
497 1.1.2.2 skrll static __inline int
498 1.1.2.4 skrll rtw_chip_reset(struct rtw_regs *regs, char (*dvname)[IFNAMSIZ])
499 1.1.2.4 skrll {
500 1.1.2.4 skrll uint32_t tcr;
501 1.1.2.4 skrll
502 1.1.2.4 skrll /* from Linux driver */
503 1.1.2.4 skrll tcr = RTW_TCR_CWMIN | RTW_TCR_MXDMA_2048 |
504 1.1.2.4 skrll LSHIFT(7, RTW_TCR_SRL_MASK) | LSHIFT(7, RTW_TCR_LRL_MASK);
505 1.1.2.4 skrll
506 1.1.2.4 skrll RTW_WRITE(regs, RTW_TCR, tcr);
507 1.1.2.4 skrll
508 1.1.2.4 skrll RTW_WBW(regs, RTW_CR, RTW_TCR);
509 1.1.2.4 skrll
510 1.1.2.4 skrll return rtw_chip_reset1(regs, dvname);
511 1.1.2.4 skrll }
512 1.1.2.4 skrll
513 1.1.2.4 skrll static __inline int
514 1.1.2.2 skrll rtw_recall_eeprom(struct rtw_regs *regs, char (*dvname)[IFNAMSIZ])
515 1.1.2.2 skrll {
516 1.1.2.2 skrll int i;
517 1.1.2.2 skrll u_int8_t ecr;
518 1.1.2.2 skrll
519 1.1.2.2 skrll ecr = RTW_READ8(regs, RTW_9346CR);
520 1.1.2.2 skrll ecr = (ecr & ~RTW_9346CR_EEM_MASK) | RTW_9346CR_EEM_AUTOLOAD;
521 1.1.2.2 skrll RTW_WRITE8(regs, RTW_9346CR, ecr);
522 1.1.2.2 skrll
523 1.1.2.2 skrll RTW_WBR(regs, RTW_9346CR, RTW_9346CR);
524 1.1.2.2 skrll
525 1.1.2.2 skrll /* wait 2.5ms for completion */
526 1.1.2.2 skrll for (i = 0; i < 25; i++) {
527 1.1.2.2 skrll ecr = RTW_READ8(regs, RTW_9346CR);
528 1.1.2.2 skrll if ((ecr & RTW_9346CR_EEM_MASK) == RTW_9346CR_EEM_NORMAL) {
529 1.1.2.2 skrll RTW_DPRINTF(("%s: recall EEPROM in %dus\n", *dvname,
530 1.1.2.2 skrll i * 100));
531 1.1.2.2 skrll return 0;
532 1.1.2.2 skrll }
533 1.1.2.2 skrll RTW_RBR(regs, RTW_9346CR, RTW_9346CR);
534 1.1.2.2 skrll DELAY(100);
535 1.1.2.2 skrll }
536 1.1.2.2 skrll printf("%s: recall EEPROM failed\n", *dvname);
537 1.1.2.2 skrll return ETIMEDOUT;
538 1.1.2.2 skrll }
539 1.1.2.2 skrll
540 1.1.2.2 skrll static __inline int
541 1.1.2.2 skrll rtw_reset(struct rtw_softc *sc)
542 1.1.2.2 skrll {
543 1.1.2.2 skrll int rc;
544 1.1.2.4 skrll uint8_t config1;
545 1.1.2.2 skrll
546 1.1.2.2 skrll if ((rc = rtw_chip_reset(&sc->sc_regs, &sc->sc_dev.dv_xname)) != 0)
547 1.1.2.2 skrll return rc;
548 1.1.2.2 skrll
549 1.1.2.2 skrll if ((rc = rtw_recall_eeprom(&sc->sc_regs, &sc->sc_dev.dv_xname)) != 0)
550 1.1.2.2 skrll ;
551 1.1.2.2 skrll
552 1.1.2.4 skrll config1 = RTW_READ8(&sc->sc_regs, RTW_CONFIG1);
553 1.1.2.4 skrll RTW_WRITE8(&sc->sc_regs, RTW_CONFIG1, config1 & ~RTW_CONFIG1_PMEN);
554 1.1.2.2 skrll /* TBD turn off maximum power saving? */
555 1.1.2.2 skrll
556 1.1.2.2 skrll return 0;
557 1.1.2.2 skrll }
558 1.1.2.2 skrll
559 1.1.2.2 skrll static __inline int
560 1.1.2.2 skrll rtw_txdesc_dmamaps_create(bus_dma_tag_t dmat, struct rtw_txctl *descs,
561 1.1.2.2 skrll u_int ndescs)
562 1.1.2.2 skrll {
563 1.1.2.2 skrll int i, rc = 0;
564 1.1.2.2 skrll for (i = 0; i < ndescs; i++) {
565 1.1.2.2 skrll rc = bus_dmamap_create(dmat, MCLBYTES, RTW_MAXPKTSEGS, MCLBYTES,
566 1.1.2.2 skrll 0, 0, &descs[i].stx_dmamap);
567 1.1.2.2 skrll if (rc != 0)
568 1.1.2.2 skrll break;
569 1.1.2.2 skrll }
570 1.1.2.2 skrll return rc;
571 1.1.2.2 skrll }
572 1.1.2.2 skrll
573 1.1.2.2 skrll static __inline int
574 1.1.2.2 skrll rtw_rxdesc_dmamaps_create(bus_dma_tag_t dmat, struct rtw_rxctl *descs,
575 1.1.2.2 skrll u_int ndescs)
576 1.1.2.2 skrll {
577 1.1.2.2 skrll int i, rc = 0;
578 1.1.2.2 skrll for (i = 0; i < ndescs; i++) {
579 1.1.2.2 skrll rc = bus_dmamap_create(dmat, MCLBYTES, 1, MCLBYTES, 0, 0,
580 1.1.2.2 skrll &descs[i].srx_dmamap);
581 1.1.2.2 skrll if (rc != 0)
582 1.1.2.2 skrll break;
583 1.1.2.2 skrll }
584 1.1.2.2 skrll return rc;
585 1.1.2.2 skrll }
586 1.1.2.2 skrll
587 1.1.2.2 skrll static __inline void
588 1.1.2.4 skrll rtw_rxctls_setup(struct rtw_rxctl *descs)
589 1.1.2.2 skrll {
590 1.1.2.2 skrll int i;
591 1.1.2.2 skrll for (i = 0; i < RTW_RXQLEN; i++)
592 1.1.2.4 skrll descs[i].srx_mbuf = NULL;
593 1.1.2.2 skrll }
594 1.1.2.2 skrll
595 1.1.2.2 skrll static __inline void
596 1.1.2.2 skrll rtw_rxdesc_dmamaps_destroy(bus_dma_tag_t dmat, struct rtw_rxctl *descs,
597 1.1.2.2 skrll u_int ndescs)
598 1.1.2.2 skrll {
599 1.1.2.2 skrll int i;
600 1.1.2.2 skrll for (i = 0; i < ndescs; i++) {
601 1.1.2.2 skrll if (descs[i].srx_dmamap != NULL)
602 1.1.2.2 skrll bus_dmamap_destroy(dmat, descs[i].srx_dmamap);
603 1.1.2.2 skrll }
604 1.1.2.2 skrll }
605 1.1.2.2 skrll
606 1.1.2.2 skrll static __inline void
607 1.1.2.2 skrll rtw_txdesc_dmamaps_destroy(bus_dma_tag_t dmat, struct rtw_txctl *descs,
608 1.1.2.2 skrll u_int ndescs)
609 1.1.2.2 skrll {
610 1.1.2.2 skrll int i;
611 1.1.2.2 skrll for (i = 0; i < ndescs; i++) {
612 1.1.2.2 skrll if (descs[i].stx_dmamap != NULL)
613 1.1.2.2 skrll bus_dmamap_destroy(dmat, descs[i].stx_dmamap);
614 1.1.2.2 skrll }
615 1.1.2.2 skrll }
616 1.1.2.2 skrll
617 1.1.2.2 skrll static __inline void
618 1.1.2.2 skrll rtw_srom_free(struct rtw_srom *sr)
619 1.1.2.2 skrll {
620 1.1.2.2 skrll sr->sr_size = 0;
621 1.1.2.2 skrll if (sr->sr_content == NULL)
622 1.1.2.2 skrll return;
623 1.1.2.2 skrll free(sr->sr_content, M_DEVBUF);
624 1.1.2.2 skrll sr->sr_content = NULL;
625 1.1.2.2 skrll }
626 1.1.2.2 skrll
627 1.1.2.2 skrll static void
628 1.1.2.2 skrll rtw_srom_defaults(struct rtw_srom *sr, u_int32_t *flags, u_int8_t *cs_threshold,
629 1.1.2.2 skrll enum rtw_rfchipid *rfchipid, u_int32_t *rcr, char (*dvname)[IFNAMSIZ])
630 1.1.2.2 skrll {
631 1.1.2.2 skrll *flags |= (RTW_F_DIGPHY|RTW_F_ANTDIV);
632 1.1.2.2 skrll *cs_threshold = RTW_SR_ENERGYDETTHR_DEFAULT;
633 1.1.2.2 skrll *rcr |= RTW_RCR_ENCS1;
634 1.1.2.2 skrll *rfchipid = RTW_RFCHIPID_PHILIPS;
635 1.1.2.2 skrll }
636 1.1.2.2 skrll
637 1.1.2.2 skrll static int
638 1.1.2.2 skrll rtw_srom_parse(struct rtw_srom *sr, u_int32_t *flags, u_int8_t *cs_threshold,
639 1.1.2.2 skrll enum rtw_rfchipid *rfchipid, u_int32_t *rcr, enum rtw_locale *locale,
640 1.1.2.2 skrll char (*dvname)[IFNAMSIZ])
641 1.1.2.2 skrll {
642 1.1.2.2 skrll int i;
643 1.1.2.2 skrll const char *rfname, *paname;
644 1.1.2.2 skrll char scratch[sizeof("unknown 0xXX")];
645 1.1.2.2 skrll u_int16_t version;
646 1.1.2.2 skrll u_int8_t mac[IEEE80211_ADDR_LEN];
647 1.1.2.2 skrll
648 1.1.2.2 skrll *flags &= ~(RTW_F_DIGPHY|RTW_F_DFLANTB|RTW_F_ANTDIV);
649 1.1.2.2 skrll *rcr &= ~(RTW_RCR_ENCS1 | RTW_RCR_ENCS2);
650 1.1.2.2 skrll
651 1.1.2.2 skrll version = RTW_SR_GET16(sr, RTW_SR_VERSION);
652 1.1.2.2 skrll printf("%s: SROM version %d.%d", *dvname, version >> 8, version & 0xff);
653 1.1.2.2 skrll
654 1.1.2.2 skrll if (version <= 0x0101) {
655 1.1.2.2 skrll printf(" is not understood, limping along with defaults\n");
656 1.1.2.2 skrll rtw_srom_defaults(sr, flags, cs_threshold, rfchipid, rcr,
657 1.1.2.2 skrll dvname);
658 1.1.2.2 skrll return 0;
659 1.1.2.2 skrll }
660 1.1.2.2 skrll printf("\n");
661 1.1.2.2 skrll
662 1.1.2.2 skrll for (i = 0; i < IEEE80211_ADDR_LEN; i++)
663 1.1.2.2 skrll mac[i] = RTW_SR_GET(sr, RTW_SR_MAC + i);
664 1.1.2.2 skrll
665 1.1.2.2 skrll RTW_DPRINTF(("%s: EEPROM MAC %s\n", *dvname, ether_sprintf(mac)));
666 1.1.2.2 skrll
667 1.1.2.2 skrll *cs_threshold = RTW_SR_GET(sr, RTW_SR_ENERGYDETTHR);
668 1.1.2.2 skrll
669 1.1.2.2 skrll if ((RTW_SR_GET(sr, RTW_SR_CONFIG2) & RTW_CONFIG2_ANT) != 0)
670 1.1.2.2 skrll *flags |= RTW_F_ANTDIV;
671 1.1.2.2 skrll
672 1.1.2.2 skrll if ((RTW_SR_GET(sr, RTW_SR_RFPARM) & RTW_SR_RFPARM_DIGPHY) != 0)
673 1.1.2.2 skrll *flags |= RTW_F_DIGPHY;
674 1.1.2.2 skrll if ((RTW_SR_GET(sr, RTW_SR_RFPARM) & RTW_SR_RFPARM_DFLANTB) != 0)
675 1.1.2.2 skrll *flags |= RTW_F_DFLANTB;
676 1.1.2.2 skrll
677 1.1.2.2 skrll *rcr |= LSHIFT(MASK_AND_RSHIFT(RTW_SR_GET(sr, RTW_SR_RFPARM),
678 1.1.2.2 skrll RTW_SR_RFPARM_CS_MASK), RTW_RCR_ENCS1);
679 1.1.2.2 skrll
680 1.1.2.2 skrll *rfchipid = RTW_SR_GET(sr, RTW_SR_RFCHIPID);
681 1.1.2.2 skrll switch (*rfchipid) {
682 1.1.2.2 skrll case RTW_RFCHIPID_GCT: /* this combo seen in the wild */
683 1.1.2.2 skrll rfname = "GCT GRF5101";
684 1.1.2.2 skrll paname = "Winspring WS9901";
685 1.1.2.2 skrll break;
686 1.1.2.2 skrll case RTW_RFCHIPID_MAXIM:
687 1.1.2.2 skrll rfname = "Maxim MAX2820"; /* guess */
688 1.1.2.2 skrll paname = "Maxim MAX2422"; /* guess */
689 1.1.2.2 skrll break;
690 1.1.2.2 skrll case RTW_RFCHIPID_INTERSIL:
691 1.1.2.2 skrll rfname = "Intersil HFA3873"; /* guess */
692 1.1.2.2 skrll paname = "Intersil <unknown>";
693 1.1.2.2 skrll break;
694 1.1.2.2 skrll case RTW_RFCHIPID_PHILIPS: /* this combo seen in the wild */
695 1.1.2.2 skrll rfname = "Philips SA2400A";
696 1.1.2.2 skrll paname = "Philips SA2411";
697 1.1.2.2 skrll break;
698 1.1.2.2 skrll case RTW_RFCHIPID_RFMD:
699 1.1.2.2 skrll /* this is the same front-end as an atw(4)! */
700 1.1.2.2 skrll rfname = "RFMD RF2948B, " /* mentioned in Realtek docs */
701 1.1.2.2 skrll "LNA: RFMD RF2494, " /* mentioned in Realtek docs */
702 1.1.2.2 skrll "SYN: Silicon Labs Si4126"; /* inferred from
703 1.1.2.2 skrll * reference driver
704 1.1.2.2 skrll */
705 1.1.2.2 skrll paname = "RFMD RF2189"; /* mentioned in Realtek docs */
706 1.1.2.2 skrll break;
707 1.1.2.2 skrll case RTW_RFCHIPID_RESERVED:
708 1.1.2.2 skrll rfname = paname = "reserved";
709 1.1.2.2 skrll break;
710 1.1.2.2 skrll default:
711 1.1.2.2 skrll snprintf(scratch, sizeof(scratch), "unknown 0x%02x", *rfchipid);
712 1.1.2.2 skrll rfname = paname = scratch;
713 1.1.2.2 skrll }
714 1.1.2.2 skrll printf("%s: RF: %s, PA: %s\n", *dvname, rfname, paname);
715 1.1.2.2 skrll
716 1.1.2.2 skrll switch (RTW_SR_GET(sr, RTW_SR_CONFIG0) & RTW_CONFIG0_GL_MASK) {
717 1.1.2.2 skrll case RTW_CONFIG0_GL_USA:
718 1.1.2.2 skrll *locale = RTW_LOCALE_USA;
719 1.1.2.2 skrll break;
720 1.1.2.2 skrll case RTW_CONFIG0_GL_EUROPE:
721 1.1.2.2 skrll *locale = RTW_LOCALE_EUROPE;
722 1.1.2.2 skrll break;
723 1.1.2.2 skrll case RTW_CONFIG0_GL_JAPAN:
724 1.1.2.2 skrll *locale = RTW_LOCALE_JAPAN;
725 1.1.2.2 skrll break;
726 1.1.2.2 skrll default:
727 1.1.2.2 skrll *locale = RTW_LOCALE_UNKNOWN;
728 1.1.2.2 skrll break;
729 1.1.2.2 skrll }
730 1.1.2.2 skrll return 0;
731 1.1.2.2 skrll }
732 1.1.2.2 skrll
733 1.1.2.2 skrll /* Returns -1 on failure. */
734 1.1.2.2 skrll static int
735 1.1.2.2 skrll rtw_srom_read(struct rtw_regs *regs, u_int32_t flags, struct rtw_srom *sr,
736 1.1.2.2 skrll char (*dvname)[IFNAMSIZ])
737 1.1.2.2 skrll {
738 1.1.2.2 skrll int rc;
739 1.1.2.2 skrll struct seeprom_descriptor sd;
740 1.1.2.2 skrll u_int8_t ecr;
741 1.1.2.2 skrll
742 1.1.2.2 skrll (void)memset(&sd, 0, sizeof(sd));
743 1.1.2.2 skrll
744 1.1.2.2 skrll ecr = RTW_READ8(regs, RTW_9346CR);
745 1.1.2.2 skrll
746 1.1.2.2 skrll if ((flags & RTW_F_9356SROM) != 0) {
747 1.1.2.2 skrll RTW_DPRINTF(("%s: 93c56 SROM\n", *dvname));
748 1.1.2.2 skrll sr->sr_size = 256;
749 1.1.2.2 skrll sd.sd_chip = C56_66;
750 1.1.2.2 skrll } else {
751 1.1.2.2 skrll RTW_DPRINTF(("%s: 93c46 SROM\n", *dvname));
752 1.1.2.2 skrll sr->sr_size = 128;
753 1.1.2.2 skrll sd.sd_chip = C46;
754 1.1.2.2 skrll }
755 1.1.2.2 skrll
756 1.1.2.2 skrll ecr &= ~(RTW_9346CR_EEDI | RTW_9346CR_EEDO | RTW_9346CR_EESK |
757 1.1.2.2 skrll RTW_9346CR_EEM_MASK);
758 1.1.2.2 skrll ecr |= RTW_9346CR_EEM_PROGRAM;
759 1.1.2.2 skrll
760 1.1.2.2 skrll RTW_WRITE8(regs, RTW_9346CR, ecr);
761 1.1.2.2 skrll
762 1.1.2.2 skrll sr->sr_content = malloc(sr->sr_size, M_DEVBUF, M_NOWAIT);
763 1.1.2.2 skrll
764 1.1.2.2 skrll if (sr->sr_content == NULL) {
765 1.1.2.2 skrll printf("%s: unable to allocate SROM buffer\n", *dvname);
766 1.1.2.2 skrll return ENOMEM;
767 1.1.2.2 skrll }
768 1.1.2.2 skrll
769 1.1.2.2 skrll (void)memset(sr->sr_content, 0, sr->sr_size);
770 1.1.2.2 skrll
771 1.1.2.2 skrll /* RTL8180 has a single 8-bit register for controlling the
772 1.1.2.2 skrll * 93cx6 SROM. There is no "ready" bit. The RTL8180
773 1.1.2.2 skrll * input/output sense is the reverse of read_seeprom's.
774 1.1.2.2 skrll */
775 1.1.2.2 skrll sd.sd_tag = regs->r_bt;
776 1.1.2.2 skrll sd.sd_bsh = regs->r_bh;
777 1.1.2.2 skrll sd.sd_regsize = 1;
778 1.1.2.2 skrll sd.sd_control_offset = RTW_9346CR;
779 1.1.2.2 skrll sd.sd_status_offset = RTW_9346CR;
780 1.1.2.2 skrll sd.sd_dataout_offset = RTW_9346CR;
781 1.1.2.2 skrll sd.sd_CK = RTW_9346CR_EESK;
782 1.1.2.2 skrll sd.sd_CS = RTW_9346CR_EECS;
783 1.1.2.2 skrll sd.sd_DI = RTW_9346CR_EEDO;
784 1.1.2.2 skrll sd.sd_DO = RTW_9346CR_EEDI;
785 1.1.2.2 skrll /* make read_seeprom enter EEPROM read/write mode */
786 1.1.2.2 skrll sd.sd_MS = ecr;
787 1.1.2.2 skrll sd.sd_RDY = 0;
788 1.1.2.2 skrll #if 0
789 1.1.2.2 skrll sd.sd_clkdelay = 50;
790 1.1.2.2 skrll #endif
791 1.1.2.2 skrll
792 1.1.2.2 skrll if (!read_seeprom(&sd, sr->sr_content, 0, sr->sr_size/2)) {
793 1.1.2.2 skrll printf("%s: could not read SROM\n", *dvname);
794 1.1.2.2 skrll free(sr->sr_content, M_DEVBUF);
795 1.1.2.2 skrll sr->sr_content = NULL;
796 1.1.2.2 skrll return -1; /* XXX */
797 1.1.2.2 skrll }
798 1.1.2.2 skrll
799 1.1.2.2 skrll /* end EEPROM read/write mode */
800 1.1.2.2 skrll RTW_WRITE8(regs, RTW_9346CR,
801 1.1.2.2 skrll (ecr & ~RTW_9346CR_EEM_MASK) | RTW_9346CR_EEM_NORMAL);
802 1.1.2.2 skrll RTW_WBRW(regs, RTW_9346CR, RTW_9346CR);
803 1.1.2.2 skrll
804 1.1.2.2 skrll if ((rc = rtw_recall_eeprom(regs, dvname)) != 0)
805 1.1.2.2 skrll return rc;
806 1.1.2.2 skrll
807 1.1.2.2 skrll #ifdef RTW_DEBUG
808 1.1.2.2 skrll {
809 1.1.2.2 skrll int i;
810 1.1.2.2 skrll RTW_DPRINTF(("\n%s: serial ROM:\n\t", *dvname));
811 1.1.2.2 skrll for (i = 0; i < sr->sr_size/2; i++) {
812 1.1.2.2 skrll if (((i % 8) == 0) && (i != 0))
813 1.1.2.2 skrll RTW_DPRINTF(("\n\t"));
814 1.1.2.2 skrll RTW_DPRINTF((" %04x", sr->sr_content[i]));
815 1.1.2.2 skrll }
816 1.1.2.2 skrll RTW_DPRINTF(("\n"));
817 1.1.2.2 skrll }
818 1.1.2.2 skrll #endif /* RTW_DEBUG */
819 1.1.2.2 skrll return 0;
820 1.1.2.2 skrll }
821 1.1.2.2 skrll
822 1.1.2.4 skrll static void
823 1.1.2.4 skrll rtw_set_rfprog(struct rtw_regs *regs, enum rtw_rfchipid rfchipid,
824 1.1.2.4 skrll const char *dvname)
825 1.1.2.4 skrll {
826 1.1.2.4 skrll u_int8_t cfg4;
827 1.1.2.4 skrll const char *method;
828 1.1.2.4 skrll
829 1.1.2.4 skrll cfg4 = RTW_READ8(regs, RTW_CONFIG4) & ~RTW_CONFIG4_RFTYPE_MASK;
830 1.1.2.4 skrll
831 1.1.2.4 skrll switch (rfchipid) {
832 1.1.2.4 skrll default:
833 1.1.2.4 skrll cfg4 |= LSHIFT(rtw_rfprog_fallback, RTW_CONFIG4_RFTYPE_MASK);
834 1.1.2.4 skrll method = "fallback";
835 1.1.2.4 skrll break;
836 1.1.2.4 skrll case RTW_RFCHIPID_INTERSIL:
837 1.1.2.4 skrll cfg4 |= RTW_CONFIG4_RFTYPE_INTERSIL;
838 1.1.2.4 skrll method = "Intersil";
839 1.1.2.4 skrll break;
840 1.1.2.4 skrll case RTW_RFCHIPID_PHILIPS:
841 1.1.2.4 skrll cfg4 |= RTW_CONFIG4_RFTYPE_PHILIPS;
842 1.1.2.4 skrll method = "Philips";
843 1.1.2.4 skrll break;
844 1.1.2.4 skrll case RTW_RFCHIPID_RFMD:
845 1.1.2.4 skrll cfg4 |= RTW_CONFIG4_RFTYPE_RFMD;
846 1.1.2.4 skrll method = "RFMD";
847 1.1.2.4 skrll break;
848 1.1.2.4 skrll }
849 1.1.2.4 skrll
850 1.1.2.4 skrll RTW_WRITE8(regs, RTW_CONFIG4, cfg4);
851 1.1.2.4 skrll
852 1.1.2.4 skrll printf("%s: %s RF programming method, %#02x\n", dvname, method,
853 1.1.2.4 skrll RTW_READ8(regs, RTW_CONFIG4));
854 1.1.2.4 skrll }
855 1.1.2.4 skrll
856 1.1.2.2 skrll #if 0
857 1.1.2.2 skrll static __inline int
858 1.1.2.2 skrll rtw_identify_rf(struct rtw_regs *regs, enum rtw_rftype *rftype,
859 1.1.2.2 skrll char (*dvname)[IFNAMSIZ])
860 1.1.2.2 skrll {
861 1.1.2.2 skrll u_int8_t cfg4;
862 1.1.2.2 skrll const char *name;
863 1.1.2.2 skrll
864 1.1.2.2 skrll cfg4 = RTW_READ8(regs, RTW_CONFIG4);
865 1.1.2.2 skrll
866 1.1.2.2 skrll switch (cfg4 & RTW_CONFIG4_RFTYPE_MASK) {
867 1.1.2.2 skrll case RTW_CONFIG4_RFTYPE_PHILIPS:
868 1.1.2.2 skrll *rftype = RTW_RFTYPE_PHILIPS;
869 1.1.2.2 skrll name = "Philips";
870 1.1.2.2 skrll break;
871 1.1.2.2 skrll case RTW_CONFIG4_RFTYPE_INTERSIL:
872 1.1.2.2 skrll *rftype = RTW_RFTYPE_INTERSIL;
873 1.1.2.2 skrll name = "Intersil";
874 1.1.2.2 skrll break;
875 1.1.2.2 skrll case RTW_CONFIG4_RFTYPE_RFMD:
876 1.1.2.2 skrll *rftype = RTW_RFTYPE_RFMD;
877 1.1.2.2 skrll name = "RFMD";
878 1.1.2.2 skrll break;
879 1.1.2.2 skrll default:
880 1.1.2.2 skrll name = "<unknown>";
881 1.1.2.2 skrll return ENXIO;
882 1.1.2.2 skrll }
883 1.1.2.2 skrll
884 1.1.2.2 skrll printf("%s: RF prog type %s\n", *dvname, name);
885 1.1.2.2 skrll return 0;
886 1.1.2.2 skrll }
887 1.1.2.2 skrll #endif
888 1.1.2.2 skrll
889 1.1.2.2 skrll static __inline void
890 1.1.2.2 skrll rtw_init_channels(enum rtw_locale locale,
891 1.1.2.2 skrll struct ieee80211_channel (*chans)[IEEE80211_CHAN_MAX+1],
892 1.1.2.2 skrll char (*dvname)[IFNAMSIZ])
893 1.1.2.2 skrll {
894 1.1.2.2 skrll int i;
895 1.1.2.2 skrll const char *name = NULL;
896 1.1.2.2 skrll #define ADD_CHANNEL(_chans, _chan) do { \
897 1.1.2.2 skrll (*_chans)[_chan].ic_flags = IEEE80211_CHAN_B; \
898 1.1.2.2 skrll (*_chans)[_chan].ic_freq = \
899 1.1.2.2 skrll ieee80211_ieee2mhz(_chan, (*_chans)[_chan].ic_flags);\
900 1.1.2.2 skrll } while (0)
901 1.1.2.2 skrll
902 1.1.2.2 skrll switch (locale) {
903 1.1.2.2 skrll case RTW_LOCALE_USA: /* 1-11 */
904 1.1.2.2 skrll name = "USA";
905 1.1.2.2 skrll for (i = 1; i <= 11; i++)
906 1.1.2.2 skrll ADD_CHANNEL(chans, i);
907 1.1.2.2 skrll break;
908 1.1.2.2 skrll case RTW_LOCALE_JAPAN: /* 1-14 */
909 1.1.2.2 skrll name = "Japan";
910 1.1.2.2 skrll ADD_CHANNEL(chans, 14);
911 1.1.2.2 skrll for (i = 1; i <= 14; i++)
912 1.1.2.2 skrll ADD_CHANNEL(chans, i);
913 1.1.2.2 skrll break;
914 1.1.2.2 skrll case RTW_LOCALE_EUROPE: /* 1-13 */
915 1.1.2.2 skrll name = "Europe";
916 1.1.2.2 skrll for (i = 1; i <= 13; i++)
917 1.1.2.2 skrll ADD_CHANNEL(chans, i);
918 1.1.2.2 skrll break;
919 1.1.2.2 skrll default: /* 10-11 allowed by most countries */
920 1.1.2.2 skrll name = "<unknown>";
921 1.1.2.2 skrll for (i = 10; i <= 11; i++)
922 1.1.2.2 skrll ADD_CHANNEL(chans, i);
923 1.1.2.2 skrll break;
924 1.1.2.2 skrll }
925 1.1.2.2 skrll printf("%s: Geographic Location %s\n", *dvname, name);
926 1.1.2.2 skrll #undef ADD_CHANNEL
927 1.1.2.2 skrll }
928 1.1.2.2 skrll
929 1.1.2.2 skrll static __inline void
930 1.1.2.2 skrll rtw_identify_country(struct rtw_regs *regs, enum rtw_locale *locale,
931 1.1.2.2 skrll char (*dvname)[IFNAMSIZ])
932 1.1.2.2 skrll {
933 1.1.2.2 skrll u_int8_t cfg0 = RTW_READ8(regs, RTW_CONFIG0);
934 1.1.2.2 skrll
935 1.1.2.2 skrll switch (cfg0 & RTW_CONFIG0_GL_MASK) {
936 1.1.2.2 skrll case RTW_CONFIG0_GL_USA:
937 1.1.2.2 skrll *locale = RTW_LOCALE_USA;
938 1.1.2.2 skrll break;
939 1.1.2.2 skrll case RTW_CONFIG0_GL_JAPAN:
940 1.1.2.2 skrll *locale = RTW_LOCALE_JAPAN;
941 1.1.2.2 skrll break;
942 1.1.2.2 skrll case RTW_CONFIG0_GL_EUROPE:
943 1.1.2.2 skrll *locale = RTW_LOCALE_EUROPE;
944 1.1.2.2 skrll break;
945 1.1.2.2 skrll default:
946 1.1.2.2 skrll *locale = RTW_LOCALE_UNKNOWN;
947 1.1.2.2 skrll break;
948 1.1.2.2 skrll }
949 1.1.2.2 skrll }
950 1.1.2.2 skrll
951 1.1.2.2 skrll static __inline int
952 1.1.2.2 skrll rtw_identify_sta(struct rtw_regs *regs, u_int8_t (*addr)[IEEE80211_ADDR_LEN],
953 1.1.2.2 skrll char (*dvname)[IFNAMSIZ])
954 1.1.2.2 skrll {
955 1.1.2.2 skrll static const u_int8_t empty_macaddr[IEEE80211_ADDR_LEN] = {
956 1.1.2.2 skrll 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
957 1.1.2.2 skrll };
958 1.1.2.2 skrll u_int32_t idr0 = RTW_READ(regs, RTW_IDR0),
959 1.1.2.2 skrll idr1 = RTW_READ(regs, RTW_IDR1);
960 1.1.2.2 skrll
961 1.1.2.2 skrll (*addr)[0] = MASK_AND_RSHIFT(idr0, BITS(0, 7));
962 1.1.2.2 skrll (*addr)[1] = MASK_AND_RSHIFT(idr0, BITS(8, 15));
963 1.1.2.2 skrll (*addr)[2] = MASK_AND_RSHIFT(idr0, BITS(16, 23));
964 1.1.2.2 skrll (*addr)[3] = MASK_AND_RSHIFT(idr0, BITS(24 ,31));
965 1.1.2.2 skrll
966 1.1.2.2 skrll (*addr)[4] = MASK_AND_RSHIFT(idr1, BITS(0, 7));
967 1.1.2.2 skrll (*addr)[5] = MASK_AND_RSHIFT(idr1, BITS(8, 15));
968 1.1.2.2 skrll
969 1.1.2.2 skrll if (IEEE80211_ADDR_EQ(addr, empty_macaddr)) {
970 1.1.2.2 skrll printf("%s: could not get mac address, attach failed\n",
971 1.1.2.2 skrll *dvname);
972 1.1.2.2 skrll return ENXIO;
973 1.1.2.2 skrll }
974 1.1.2.2 skrll
975 1.1.2.2 skrll printf("%s: 802.11 address %s\n", *dvname, ether_sprintf(*addr));
976 1.1.2.2 skrll
977 1.1.2.2 skrll return 0;
978 1.1.2.2 skrll }
979 1.1.2.2 skrll
980 1.1.2.2 skrll static u_int8_t
981 1.1.2.2 skrll rtw_chan2txpower(struct rtw_srom *sr, struct ieee80211com *ic,
982 1.1.2.2 skrll struct ieee80211_channel *chan)
983 1.1.2.2 skrll {
984 1.1.2.2 skrll u_int idx = RTW_SR_TXPOWER1 + ieee80211_chan2ieee(ic, chan) - 1;
985 1.1.2.2 skrll KASSERT2(idx >= RTW_SR_TXPOWER1 && idx <= RTW_SR_TXPOWER14,
986 1.1.2.2 skrll ("%s: channel %d out of range", __func__,
987 1.1.2.2 skrll idx - RTW_SR_TXPOWER1 + 1));
988 1.1.2.2 skrll return RTW_SR_GET(sr, idx);
989 1.1.2.2 skrll }
990 1.1.2.2 skrll
991 1.1.2.2 skrll static void
992 1.1.2.4 skrll rtw_txdesc_blk_init_all(struct rtw_txdesc_blk *htcs)
993 1.1.2.2 skrll {
994 1.1.2.2 skrll int pri;
995 1.1.2.2 skrll u_int ndesc[RTW_NTXPRI] =
996 1.1.2.2 skrll {RTW_NTXDESCLO, RTW_NTXDESCMD, RTW_NTXDESCHI, RTW_NTXDESCBCN};
997 1.1.2.2 skrll
998 1.1.2.2 skrll for (pri = 0; pri < RTW_NTXPRI; pri++) {
999 1.1.2.4 skrll htcs[pri].htc_nfree = ndesc[pri];
1000 1.1.2.4 skrll htcs[pri].htc_next = 0;
1001 1.1.2.2 skrll }
1002 1.1.2.2 skrll }
1003 1.1.2.2 skrll
1004 1.1.2.2 skrll static int
1005 1.1.2.2 skrll rtw_txctl_blk_init(struct rtw_txctl_blk *stc)
1006 1.1.2.2 skrll {
1007 1.1.2.2 skrll int i;
1008 1.1.2.2 skrll struct rtw_txctl *stx;
1009 1.1.2.2 skrll
1010 1.1.2.2 skrll SIMPLEQ_INIT(&stc->stc_dirtyq);
1011 1.1.2.2 skrll SIMPLEQ_INIT(&stc->stc_freeq);
1012 1.1.2.2 skrll for (i = 0; i < stc->stc_ndesc; i++) {
1013 1.1.2.2 skrll stx = &stc->stc_desc[i];
1014 1.1.2.2 skrll stx->stx_mbuf = NULL;
1015 1.1.2.2 skrll SIMPLEQ_INSERT_TAIL(&stc->stc_freeq, stx, stx_q);
1016 1.1.2.2 skrll }
1017 1.1.2.2 skrll return 0;
1018 1.1.2.2 skrll }
1019 1.1.2.2 skrll
1020 1.1.2.2 skrll static void
1021 1.1.2.4 skrll rtw_txctl_blk_init_all(struct rtw_txctl_blk *stcs)
1022 1.1.2.2 skrll {
1023 1.1.2.2 skrll int pri;
1024 1.1.2.4 skrll for (pri = 0; pri < RTW_NTXPRI; pri++)
1025 1.1.2.4 skrll rtw_txctl_blk_init(&stcs[pri]);
1026 1.1.2.2 skrll }
1027 1.1.2.2 skrll
1028 1.1.2.2 skrll static __inline void
1029 1.1.2.2 skrll rtw_rxdescs_sync(bus_dma_tag_t dmat, bus_dmamap_t dmap, u_int desc0, u_int
1030 1.1.2.2 skrll nsync, int ops)
1031 1.1.2.2 skrll {
1032 1.1.2.2 skrll /* sync to end of ring */
1033 1.1.2.2 skrll if (desc0 + nsync > RTW_NRXDESC) {
1034 1.1.2.2 skrll bus_dmamap_sync(dmat, dmap,
1035 1.1.2.2 skrll offsetof(struct rtw_descs, hd_rx[desc0]),
1036 1.1.2.2 skrll sizeof(struct rtw_rxdesc) * (RTW_NRXDESC - desc0), ops);
1037 1.1.2.2 skrll nsync -= (RTW_NRXDESC - desc0);
1038 1.1.2.2 skrll desc0 = 0;
1039 1.1.2.2 skrll }
1040 1.1.2.2 skrll
1041 1.1.2.2 skrll /* sync what remains */
1042 1.1.2.2 skrll bus_dmamap_sync(dmat, dmap,
1043 1.1.2.2 skrll offsetof(struct rtw_descs, hd_rx[desc0]),
1044 1.1.2.2 skrll sizeof(struct rtw_rxdesc) * nsync, ops);
1045 1.1.2.2 skrll }
1046 1.1.2.2 skrll
1047 1.1.2.2 skrll static void
1048 1.1.2.2 skrll rtw_txdescs_sync(bus_dma_tag_t dmat, bus_dmamap_t dmap,
1049 1.1.2.2 skrll struct rtw_txdesc_blk *htc, u_int desc0, u_int nsync, int ops)
1050 1.1.2.2 skrll {
1051 1.1.2.2 skrll /* sync to end of ring */
1052 1.1.2.2 skrll if (desc0 + nsync > htc->htc_ndesc) {
1053 1.1.2.2 skrll bus_dmamap_sync(dmat, dmap,
1054 1.1.2.2 skrll htc->htc_ofs + sizeof(struct rtw_txdesc) * desc0,
1055 1.1.2.2 skrll sizeof(struct rtw_txdesc) * (htc->htc_ndesc - desc0),
1056 1.1.2.2 skrll ops);
1057 1.1.2.2 skrll nsync -= (htc->htc_ndesc - desc0);
1058 1.1.2.2 skrll desc0 = 0;
1059 1.1.2.2 skrll }
1060 1.1.2.2 skrll
1061 1.1.2.2 skrll /* sync what remains */
1062 1.1.2.2 skrll bus_dmamap_sync(dmat, dmap,
1063 1.1.2.2 skrll htc->htc_ofs + sizeof(struct rtw_txdesc) * desc0,
1064 1.1.2.2 skrll sizeof(struct rtw_txdesc) * nsync, ops);
1065 1.1.2.2 skrll }
1066 1.1.2.2 skrll
1067 1.1.2.2 skrll static void
1068 1.1.2.2 skrll rtw_txdescs_sync_all(bus_dma_tag_t dmat, bus_dmamap_t dmap,
1069 1.1.2.4 skrll struct rtw_txdesc_blk *htcs)
1070 1.1.2.2 skrll {
1071 1.1.2.2 skrll int pri;
1072 1.1.2.2 skrll for (pri = 0; pri < RTW_NTXPRI; pri++) {
1073 1.1.2.2 skrll rtw_txdescs_sync(dmat, dmap,
1074 1.1.2.4 skrll &htcs[pri], 0, htcs[pri].htc_ndesc,
1075 1.1.2.2 skrll BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
1076 1.1.2.2 skrll }
1077 1.1.2.2 skrll }
1078 1.1.2.2 skrll
1079 1.1.2.2 skrll static void
1080 1.1.2.2 skrll rtw_rxbufs_release(bus_dma_tag_t dmat, struct rtw_rxctl *desc)
1081 1.1.2.2 skrll {
1082 1.1.2.2 skrll int i;
1083 1.1.2.2 skrll struct rtw_rxctl *srx;
1084 1.1.2.2 skrll
1085 1.1.2.2 skrll for (i = 0; i < RTW_NRXDESC; i++) {
1086 1.1.2.2 skrll srx = &desc[i];
1087 1.1.2.2 skrll bus_dmamap_unload(dmat, srx->srx_dmamap);
1088 1.1.2.2 skrll m_freem(srx->srx_mbuf);
1089 1.1.2.2 skrll srx->srx_mbuf = NULL;
1090 1.1.2.2 skrll }
1091 1.1.2.2 skrll }
1092 1.1.2.2 skrll
1093 1.1.2.2 skrll static __inline int
1094 1.1.2.2 skrll rtw_rxbuf_alloc(bus_dma_tag_t dmat, struct rtw_rxctl *srx)
1095 1.1.2.2 skrll {
1096 1.1.2.2 skrll int rc;
1097 1.1.2.2 skrll struct mbuf *m;
1098 1.1.2.2 skrll
1099 1.1.2.2 skrll MGETHDR(m, M_DONTWAIT, MT_DATA);
1100 1.1.2.2 skrll if (m == NULL)
1101 1.1.2.2 skrll return ENOMEM;
1102 1.1.2.2 skrll
1103 1.1.2.2 skrll MCLGET(m, M_DONTWAIT);
1104 1.1.2.2 skrll if (m == NULL)
1105 1.1.2.2 skrll return ENOMEM;
1106 1.1.2.2 skrll
1107 1.1.2.2 skrll m->m_pkthdr.len = m->m_len = m->m_ext.ext_size;
1108 1.1.2.2 skrll
1109 1.1.2.2 skrll rc = bus_dmamap_load_mbuf(dmat, srx->srx_dmamap, m, BUS_DMA_NOWAIT);
1110 1.1.2.2 skrll if (rc != 0)
1111 1.1.2.2 skrll return rc;
1112 1.1.2.2 skrll
1113 1.1.2.2 skrll srx->srx_mbuf = m;
1114 1.1.2.2 skrll
1115 1.1.2.2 skrll return 0;
1116 1.1.2.2 skrll }
1117 1.1.2.2 skrll
1118 1.1.2.2 skrll static int
1119 1.1.2.2 skrll rtw_rxctl_init_all(bus_dma_tag_t dmat, struct rtw_rxctl *desc,
1120 1.1.2.2 skrll u_int *next, char (*dvname)[IFNAMSIZ])
1121 1.1.2.2 skrll {
1122 1.1.2.2 skrll int i, rc;
1123 1.1.2.2 skrll struct rtw_rxctl *srx;
1124 1.1.2.2 skrll
1125 1.1.2.2 skrll for (i = 0; i < RTW_NRXDESC; i++) {
1126 1.1.2.2 skrll srx = &desc[i];
1127 1.1.2.2 skrll if ((rc = rtw_rxbuf_alloc(dmat, srx)) == 0)
1128 1.1.2.2 skrll continue;
1129 1.1.2.2 skrll printf("%s: failed rtw_rxbuf_alloc after %d buffers, rc = %d\n",
1130 1.1.2.2 skrll *dvname, i, rc);
1131 1.1.2.2 skrll if (i == 0) {
1132 1.1.2.2 skrll rtw_rxbufs_release(dmat, desc);
1133 1.1.2.2 skrll return rc;
1134 1.1.2.2 skrll }
1135 1.1.2.2 skrll }
1136 1.1.2.2 skrll *next = 0;
1137 1.1.2.2 skrll return 0;
1138 1.1.2.2 skrll }
1139 1.1.2.2 skrll
1140 1.1.2.2 skrll static __inline void
1141 1.1.2.2 skrll rtw_rxdesc_init(bus_dma_tag_t dmat, bus_dmamap_t dmam,
1142 1.1.2.2 skrll struct rtw_rxdesc *hrx, struct rtw_rxctl *srx, int idx)
1143 1.1.2.2 skrll {
1144 1.1.2.2 skrll int is_last = (idx == RTW_NRXDESC - 1);
1145 1.1.2.2 skrll uint32_t ctl;
1146 1.1.2.2 skrll
1147 1.1.2.2 skrll hrx->hrx_buf = htole32(srx->srx_dmamap->dm_segs[0].ds_addr);
1148 1.1.2.2 skrll
1149 1.1.2.2 skrll ctl = LSHIFT(srx->srx_mbuf->m_len, RTW_RXCTL_LENGTH_MASK) |
1150 1.1.2.2 skrll RTW_RXCTL_OWN | RTW_RXCTL_FS | RTW_RXCTL_LS;
1151 1.1.2.2 skrll
1152 1.1.2.2 skrll if (is_last)
1153 1.1.2.2 skrll ctl |= RTW_RXCTL_EOR;
1154 1.1.2.2 skrll
1155 1.1.2.2 skrll hrx->hrx_ctl = htole32(ctl);
1156 1.1.2.2 skrll
1157 1.1.2.2 skrll /* sync the mbuf */
1158 1.1.2.2 skrll bus_dmamap_sync(dmat, srx->srx_dmamap, 0, srx->srx_dmamap->dm_mapsize,
1159 1.1.2.2 skrll BUS_DMASYNC_PREREAD);
1160 1.1.2.2 skrll
1161 1.1.2.2 skrll /* sync the descriptor */
1162 1.1.2.2 skrll bus_dmamap_sync(dmat, dmam, RTW_DESC_OFFSET(hd_rx, idx),
1163 1.1.2.2 skrll sizeof(struct rtw_rxdesc),
1164 1.1.2.2 skrll BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
1165 1.1.2.2 skrll }
1166 1.1.2.2 skrll
1167 1.1.2.2 skrll static void
1168 1.1.2.2 skrll rtw_rxdesc_init_all(bus_dma_tag_t dmat, bus_dmamap_t dmam,
1169 1.1.2.2 skrll struct rtw_rxdesc *desc, struct rtw_rxctl *ctl)
1170 1.1.2.2 skrll {
1171 1.1.2.2 skrll int i;
1172 1.1.2.2 skrll struct rtw_rxdesc *hrx;
1173 1.1.2.2 skrll struct rtw_rxctl *srx;
1174 1.1.2.2 skrll
1175 1.1.2.2 skrll for (i = 0; i < RTW_NRXDESC; i++) {
1176 1.1.2.2 skrll hrx = &desc[i];
1177 1.1.2.2 skrll srx = &ctl[i];
1178 1.1.2.2 skrll rtw_rxdesc_init(dmat, dmam, hrx, srx, i);
1179 1.1.2.2 skrll }
1180 1.1.2.2 skrll }
1181 1.1.2.2 skrll
1182 1.1.2.2 skrll static void
1183 1.1.2.2 skrll rtw_io_enable(struct rtw_regs *regs, u_int8_t flags, int enable)
1184 1.1.2.2 skrll {
1185 1.1.2.2 skrll u_int8_t cr;
1186 1.1.2.2 skrll
1187 1.1.2.2 skrll RTW_DPRINTF(("%s: %s 0x%02x\n", __func__,
1188 1.1.2.2 skrll enable ? "enable" : "disable", flags));
1189 1.1.2.2 skrll
1190 1.1.2.2 skrll cr = RTW_READ8(regs, RTW_CR);
1191 1.1.2.2 skrll
1192 1.1.2.2 skrll /* XXX reference source does not enable MULRW */
1193 1.1.2.2 skrll #if 0
1194 1.1.2.2 skrll /* enable PCI Read/Write Multiple */
1195 1.1.2.2 skrll cr |= RTW_CR_MULRW;
1196 1.1.2.2 skrll #endif
1197 1.1.2.2 skrll
1198 1.1.2.2 skrll RTW_RBW(regs, RTW_CR, RTW_CR); /* XXX paranoia? */
1199 1.1.2.2 skrll if (enable)
1200 1.1.2.2 skrll cr |= flags;
1201 1.1.2.2 skrll else
1202 1.1.2.2 skrll cr &= ~flags;
1203 1.1.2.2 skrll RTW_WRITE8(regs, RTW_CR, cr);
1204 1.1.2.2 skrll RTW_SYNC(regs, RTW_CR, RTW_CR);
1205 1.1.2.2 skrll }
1206 1.1.2.2 skrll
1207 1.1.2.2 skrll static void
1208 1.1.2.2 skrll rtw_intr_rx(struct rtw_softc *sc, u_int16_t isr)
1209 1.1.2.2 skrll {
1210 1.1.2.2 skrll u_int next;
1211 1.1.2.2 skrll int rate, rssi;
1212 1.1.2.2 skrll u_int32_t hrssi, hstat, htsfth, htsftl;
1213 1.1.2.2 skrll struct rtw_rxdesc *hrx;
1214 1.1.2.2 skrll struct rtw_rxctl *srx;
1215 1.1.2.2 skrll struct mbuf *m;
1216 1.1.2.2 skrll
1217 1.1.2.2 skrll struct ieee80211_node *ni;
1218 1.1.2.2 skrll struct ieee80211_frame *wh;
1219 1.1.2.2 skrll
1220 1.1.2.2 skrll for (next = sc->sc_rxnext; ; next = (next + 1) % RTW_RXQLEN) {
1221 1.1.2.2 skrll rtw_rxdescs_sync(sc->sc_dmat, sc->sc_desc_dmamap,
1222 1.1.2.2 skrll next, 1, BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
1223 1.1.2.2 skrll hrx = &sc->sc_rxdesc[next];
1224 1.1.2.2 skrll srx = &sc->sc_rxctl[next];
1225 1.1.2.2 skrll
1226 1.1.2.2 skrll hstat = le32toh(hrx->hrx_stat);
1227 1.1.2.2 skrll hrssi = le32toh(hrx->hrx_rssi);
1228 1.1.2.2 skrll htsfth = le32toh(hrx->hrx_tsfth);
1229 1.1.2.2 skrll htsftl = le32toh(hrx->hrx_tsftl);
1230 1.1.2.2 skrll
1231 1.1.2.2 skrll RTW_DPRINTF2(("%s: rxdesc[%d] hstat %#08x hrssi %#08x "
1232 1.1.2.2 skrll "htsft %#08x%08x\n", __func__, next,
1233 1.1.2.2 skrll hstat, hrssi, htsfth, htsftl));
1234 1.1.2.2 skrll
1235 1.1.2.2 skrll if ((hstat & RTW_RXSTAT_OWN) != 0) /* belongs to NIC */
1236 1.1.2.2 skrll break;
1237 1.1.2.2 skrll
1238 1.1.2.2 skrll if ((hstat & RTW_RXSTAT_IOERROR) != 0) {
1239 1.1.2.2 skrll printf("%s: DMA error/FIFO overflow %08x, "
1240 1.1.2.2 skrll "rx descriptor %d\n", sc->sc_dev.dv_xname,
1241 1.1.2.2 skrll hstat & RTW_RXSTAT_IOERROR, next);
1242 1.1.2.2 skrll goto next;
1243 1.1.2.2 skrll }
1244 1.1.2.2 skrll
1245 1.1.2.2 skrll switch (hstat & RTW_RXSTAT_RATE_MASK) {
1246 1.1.2.2 skrll case RTW_RXSTAT_RATE_1MBPS:
1247 1.1.2.2 skrll rate = 10;
1248 1.1.2.2 skrll break;
1249 1.1.2.2 skrll case RTW_RXSTAT_RATE_2MBPS:
1250 1.1.2.2 skrll rate = 20;
1251 1.1.2.2 skrll break;
1252 1.1.2.2 skrll case RTW_RXSTAT_RATE_5MBPS:
1253 1.1.2.2 skrll rate = 55;
1254 1.1.2.2 skrll break;
1255 1.1.2.2 skrll default:
1256 1.1.2.2 skrll #ifdef RTW_DEBUG
1257 1.1.2.2 skrll if (rtw_debug > 1)
1258 1.1.2.2 skrll printf("%s: interpreting rate #%d as 11 MB/s\n",
1259 1.1.2.2 skrll sc->sc_dev.dv_xname,
1260 1.1.2.2 skrll MASK_AND_RSHIFT(hstat,
1261 1.1.2.2 skrll RTW_RXSTAT_RATE_MASK));
1262 1.1.2.2 skrll #endif /* RTW_DEBUG */
1263 1.1.2.2 skrll /*FALLTHROUGH*/
1264 1.1.2.2 skrll case RTW_RXSTAT_RATE_11MBPS:
1265 1.1.2.2 skrll rate = 110;
1266 1.1.2.2 skrll break;
1267 1.1.2.2 skrll }
1268 1.1.2.2 skrll
1269 1.1.2.2 skrll RTW_DPRINTF2(("%s: rate %d\n", __func__, rate));
1270 1.1.2.2 skrll
1271 1.1.2.2 skrll #ifdef RTW_DEBUG
1272 1.1.2.2 skrll #define PRINTSTAT(flag) do { \
1273 1.1.2.2 skrll if ((hstat & flag) != 0) { \
1274 1.1.2.2 skrll printf("%s" #flag, delim); \
1275 1.1.2.2 skrll delim = ","; \
1276 1.1.2.2 skrll } \
1277 1.1.2.2 skrll } while (0)
1278 1.1.2.2 skrll if (rtw_debug > 1) {
1279 1.1.2.2 skrll const char *delim = "<";
1280 1.1.2.2 skrll printf("%s: ", sc->sc_dev.dv_xname);
1281 1.1.2.2 skrll if ((hstat & RTW_RXSTAT_DEBUG) != 0) {
1282 1.1.2.2 skrll printf("status %08x<", hstat);
1283 1.1.2.2 skrll PRINTSTAT(RTW_RXSTAT_SPLCP);
1284 1.1.2.2 skrll PRINTSTAT(RTW_RXSTAT_MAR);
1285 1.1.2.2 skrll PRINTSTAT(RTW_RXSTAT_PAR);
1286 1.1.2.2 skrll PRINTSTAT(RTW_RXSTAT_BAR);
1287 1.1.2.2 skrll PRINTSTAT(RTW_RXSTAT_PWRMGT);
1288 1.1.2.2 skrll PRINTSTAT(RTW_RXSTAT_CRC32);
1289 1.1.2.2 skrll PRINTSTAT(RTW_RXSTAT_ICV);
1290 1.1.2.2 skrll printf(">, ");
1291 1.1.2.2 skrll }
1292 1.1.2.2 skrll printf("rate %d.%d Mb/s, time %08x%08x\n",
1293 1.1.2.2 skrll rate / 10, rate % 10, htsfth, htsftl);
1294 1.1.2.2 skrll }
1295 1.1.2.2 skrll #endif /* RTW_DEBUG */
1296 1.1.2.2 skrll
1297 1.1.2.2 skrll if ((hstat & RTW_RXSTAT_RES) != 0 &&
1298 1.1.2.2 skrll sc->sc_ic.ic_opmode != IEEE80211_M_MONITOR)
1299 1.1.2.2 skrll goto next;
1300 1.1.2.2 skrll
1301 1.1.2.2 skrll /* if bad flags, skip descriptor */
1302 1.1.2.2 skrll if ((hstat & RTW_RXSTAT_ONESEG) != RTW_RXSTAT_ONESEG) {
1303 1.1.2.2 skrll printf("%s: too many rx segments\n",
1304 1.1.2.2 skrll sc->sc_dev.dv_xname);
1305 1.1.2.2 skrll goto next;
1306 1.1.2.2 skrll }
1307 1.1.2.2 skrll
1308 1.1.2.2 skrll m = srx->srx_mbuf;
1309 1.1.2.2 skrll
1310 1.1.2.2 skrll /* if temporarily out of memory, re-use mbuf */
1311 1.1.2.2 skrll if (rtw_rxbuf_alloc(sc->sc_dmat, srx) != 0) {
1312 1.1.2.2 skrll printf("%s: rtw_rxbuf_alloc(, %d) failed, "
1313 1.1.2.2 skrll "dropping this packet\n", sc->sc_dev.dv_xname,
1314 1.1.2.2 skrll next);
1315 1.1.2.2 skrll goto next;
1316 1.1.2.2 skrll }
1317 1.1.2.2 skrll
1318 1.1.2.2 skrll if (sc->sc_rfchipid == RTW_RFCHIPID_PHILIPS)
1319 1.1.2.2 skrll rssi = MASK_AND_RSHIFT(hrssi, RTW_RXRSSI_RSSI);
1320 1.1.2.2 skrll else {
1321 1.1.2.2 skrll rssi = MASK_AND_RSHIFT(hrssi, RTW_RXRSSI_IMR_RSSI);
1322 1.1.2.2 skrll /* TBD find out each front-end's LNA gain in the
1323 1.1.2.2 skrll * front-end's units
1324 1.1.2.2 skrll */
1325 1.1.2.2 skrll if ((hrssi & RTW_RXRSSI_IMR_LNA) == 0)
1326 1.1.2.2 skrll rssi |= 0x80;
1327 1.1.2.2 skrll }
1328 1.1.2.2 skrll
1329 1.1.2.2 skrll m->m_pkthdr.len = m->m_len =
1330 1.1.2.2 skrll MASK_AND_RSHIFT(hstat, RTW_RXSTAT_LENGTH_MASK);
1331 1.1.2.2 skrll m->m_flags |= M_HASFCS;
1332 1.1.2.2 skrll
1333 1.1.2.4 skrll if (m->m_pkthdr.len < IEEE80211_MIN_LEN) {
1334 1.1.2.4 skrll sc->sc_ic.ic_stats.is_rx_tooshort++;
1335 1.1.2.4 skrll goto next;
1336 1.1.2.4 skrll }
1337 1.1.2.2 skrll wh = mtod(m, struct ieee80211_frame *);
1338 1.1.2.2 skrll /* TBD use _MAR, _BAR, _PAR flags as hints to _find_rxnode? */
1339 1.1.2.2 skrll ni = ieee80211_find_rxnode(&sc->sc_ic, wh);
1340 1.1.2.2 skrll
1341 1.1.2.2 skrll sc->sc_tsfth = htsfth;
1342 1.1.2.2 skrll
1343 1.1.2.2 skrll ieee80211_input(&sc->sc_if, m, ni, rssi, htsftl);
1344 1.1.2.2 skrll ieee80211_release_node(&sc->sc_ic, ni);
1345 1.1.2.2 skrll next:
1346 1.1.2.2 skrll rtw_rxdesc_init(sc->sc_dmat, sc->sc_desc_dmamap,
1347 1.1.2.2 skrll hrx, srx, next);
1348 1.1.2.2 skrll }
1349 1.1.2.2 skrll sc->sc_rxnext = next;
1350 1.1.2.4 skrll
1351 1.1.2.2 skrll return;
1352 1.1.2.2 skrll }
1353 1.1.2.2 skrll
1354 1.1.2.2 skrll static void
1355 1.1.2.2 skrll rtw_intr_tx(struct rtw_softc *sc, u_int16_t isr)
1356 1.1.2.2 skrll {
1357 1.1.2.2 skrll /* TBD */
1358 1.1.2.2 skrll return;
1359 1.1.2.2 skrll }
1360 1.1.2.2 skrll
1361 1.1.2.2 skrll static void
1362 1.1.2.2 skrll rtw_intr_beacon(struct rtw_softc *sc, u_int16_t isr)
1363 1.1.2.2 skrll {
1364 1.1.2.2 skrll /* TBD */
1365 1.1.2.2 skrll return;
1366 1.1.2.2 skrll }
1367 1.1.2.2 skrll
1368 1.1.2.2 skrll static void
1369 1.1.2.2 skrll rtw_intr_atim(struct rtw_softc *sc)
1370 1.1.2.2 skrll {
1371 1.1.2.2 skrll /* TBD */
1372 1.1.2.2 skrll return;
1373 1.1.2.2 skrll }
1374 1.1.2.2 skrll
1375 1.1.2.2 skrll static void
1376 1.1.2.4 skrll rtw_hwring_setup(struct rtw_softc *sc)
1377 1.1.2.4 skrll {
1378 1.1.2.4 skrll struct rtw_regs *regs = &sc->sc_regs;
1379 1.1.2.4 skrll RTW_WRITE(regs, RTW_RDSAR, RTW_RING_BASE(sc, hd_rx));
1380 1.1.2.4 skrll RTW_WRITE(regs, RTW_TLPDA, RTW_RING_BASE(sc, hd_txlo));
1381 1.1.2.4 skrll RTW_WRITE(regs, RTW_TNPDA, RTW_RING_BASE(sc, hd_txmd));
1382 1.1.2.4 skrll RTW_WRITE(regs, RTW_THPDA, RTW_RING_BASE(sc, hd_txhi));
1383 1.1.2.4 skrll RTW_WRITE(regs, RTW_TBDA, RTW_RING_BASE(sc, hd_bcn));
1384 1.1.2.4 skrll }
1385 1.1.2.4 skrll
1386 1.1.2.4 skrll static void
1387 1.1.2.4 skrll rtw_swring_setup(struct rtw_softc *sc)
1388 1.1.2.4 skrll {
1389 1.1.2.4 skrll rtw_txdesc_blk_init_all(&sc->sc_txdesc_blk[0]);
1390 1.1.2.4 skrll
1391 1.1.2.4 skrll rtw_txctl_blk_init_all(&sc->sc_txctl_blk[0]);
1392 1.1.2.4 skrll
1393 1.1.2.4 skrll rtw_rxctl_init_all(sc->sc_dmat, sc->sc_rxctl, &sc->sc_rxnext,
1394 1.1.2.4 skrll &sc->sc_dev.dv_xname);
1395 1.1.2.4 skrll rtw_rxdesc_init_all(sc->sc_dmat, sc->sc_desc_dmamap,
1396 1.1.2.4 skrll sc->sc_rxdesc, sc->sc_rxctl);
1397 1.1.2.4 skrll
1398 1.1.2.4 skrll rtw_txdescs_sync_all(sc->sc_dmat, sc->sc_desc_dmamap,
1399 1.1.2.4 skrll &sc->sc_txdesc_blk[0]);
1400 1.1.2.4 skrll #if 0 /* redundant with rtw_rxdesc_init_all */
1401 1.1.2.4 skrll rtw_rxdescs_sync(sc->sc_dmat, sc->sc_desc_dmamap,
1402 1.1.2.4 skrll 0, RTW_NRXDESC, BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
1403 1.1.2.4 skrll #endif
1404 1.1.2.4 skrll }
1405 1.1.2.4 skrll
1406 1.1.2.4 skrll static void
1407 1.1.2.4 skrll rtw_kick(struct rtw_softc *sc)
1408 1.1.2.4 skrll {
1409 1.1.2.4 skrll struct rtw_regs *regs = &sc->sc_regs;
1410 1.1.2.4 skrll rtw_io_enable(regs, RTW_CR_RE | RTW_CR_TE, 0);
1411 1.1.2.4 skrll RTW_WRITE16(regs, RTW_IMR, 0);
1412 1.1.2.4 skrll rtw_rxbufs_release(sc->sc_dmat, &sc->sc_rxctl[0]);
1413 1.1.2.4 skrll /* TBD free tx bufs */
1414 1.1.2.4 skrll rtw_swring_setup(sc);
1415 1.1.2.4 skrll rtw_hwring_setup(sc);
1416 1.1.2.4 skrll RTW_WRITE16(regs, RTW_IMR, sc->sc_inten);
1417 1.1.2.4 skrll rtw_io_enable(regs, RTW_CR_RE | RTW_CR_TE, 1);
1418 1.1.2.4 skrll }
1419 1.1.2.4 skrll
1420 1.1.2.4 skrll static void
1421 1.1.2.2 skrll rtw_intr_ioerror(struct rtw_softc *sc, u_int16_t isr)
1422 1.1.2.2 skrll {
1423 1.1.2.2 skrll if ((isr & (RTW_INTR_RDU|RTW_INTR_RXFOVW)) != 0) {
1424 1.1.2.4 skrll rtw_kick(sc);
1425 1.1.2.2 skrll }
1426 1.1.2.2 skrll if ((isr & RTW_INTR_TXFOVW) != 0)
1427 1.1.2.2 skrll ; /* TBD restart transmit engine */
1428 1.1.2.2 skrll return;
1429 1.1.2.2 skrll }
1430 1.1.2.2 skrll
1431 1.1.2.2 skrll static __inline void
1432 1.1.2.2 skrll rtw_suspend_ticks(struct rtw_softc *sc)
1433 1.1.2.2 skrll {
1434 1.1.2.2 skrll printf("%s: suspending ticks\n", sc->sc_dev.dv_xname);
1435 1.1.2.2 skrll sc->sc_do_tick = 0;
1436 1.1.2.2 skrll }
1437 1.1.2.2 skrll
1438 1.1.2.2 skrll static __inline void
1439 1.1.2.2 skrll rtw_resume_ticks(struct rtw_softc *sc)
1440 1.1.2.2 skrll {
1441 1.1.2.2 skrll u_int32_t tsftrl0, tsftrl1, next_tick;
1442 1.1.2.2 skrll
1443 1.1.2.2 skrll tsftrl0 = RTW_READ(&sc->sc_regs, RTW_TSFTRL);
1444 1.1.2.2 skrll
1445 1.1.2.2 skrll tsftrl1 = RTW_READ(&sc->sc_regs, RTW_TSFTRL);
1446 1.1.2.4 skrll next_tick = tsftrl1 + 1000000;
1447 1.1.2.2 skrll RTW_WRITE(&sc->sc_regs, RTW_TINT, next_tick);
1448 1.1.2.2 skrll
1449 1.1.2.2 skrll sc->sc_do_tick = 1;
1450 1.1.2.2 skrll
1451 1.1.2.2 skrll printf("%s: resume ticks delta %#08x now %#08x next %#08x\n",
1452 1.1.2.2 skrll sc->sc_dev.dv_xname, tsftrl1 - tsftrl0, tsftrl1, next_tick);
1453 1.1.2.2 skrll }
1454 1.1.2.2 skrll
1455 1.1.2.2 skrll static void
1456 1.1.2.2 skrll rtw_intr_timeout(struct rtw_softc *sc)
1457 1.1.2.2 skrll {
1458 1.1.2.2 skrll printf("%s: timeout\n", sc->sc_dev.dv_xname);
1459 1.1.2.2 skrll if (sc->sc_do_tick)
1460 1.1.2.2 skrll rtw_resume_ticks(sc);
1461 1.1.2.2 skrll return;
1462 1.1.2.2 skrll }
1463 1.1.2.2 skrll
1464 1.1.2.2 skrll int
1465 1.1.2.2 skrll rtw_intr(void *arg)
1466 1.1.2.2 skrll {
1467 1.1.2.4 skrll int i;
1468 1.1.2.2 skrll struct rtw_softc *sc = arg;
1469 1.1.2.2 skrll struct rtw_regs *regs = &sc->sc_regs;
1470 1.1.2.2 skrll u_int16_t isr;
1471 1.1.2.2 skrll
1472 1.1.2.2 skrll /*
1473 1.1.2.2 skrll * If the interface isn't running, the interrupt couldn't
1474 1.1.2.2 skrll * possibly have come from us.
1475 1.1.2.2 skrll */
1476 1.1.2.4 skrll if ((sc->sc_flags & RTW_F_ENABLED) == 0 ||
1477 1.1.2.4 skrll (sc->sc_if.if_flags & IFF_RUNNING) == 0 ||
1478 1.1.2.2 skrll (sc->sc_dev.dv_flags & DVF_ACTIVE) == 0) {
1479 1.1.2.2 skrll RTW_DPRINTF2(("%s: stray interrupt\n", sc->sc_dev.dv_xname));
1480 1.1.2.2 skrll return (0);
1481 1.1.2.2 skrll }
1482 1.1.2.2 skrll
1483 1.1.2.4 skrll for (i = 0; i < 10; i++) {
1484 1.1.2.2 skrll isr = RTW_READ16(regs, RTW_ISR);
1485 1.1.2.2 skrll
1486 1.1.2.2 skrll RTW_WRITE16(regs, RTW_ISR, isr);
1487 1.1.2.2 skrll
1488 1.1.2.2 skrll if (sc->sc_intr_ack != NULL)
1489 1.1.2.2 skrll (*sc->sc_intr_ack)(regs);
1490 1.1.2.2 skrll
1491 1.1.2.2 skrll if (isr == 0)
1492 1.1.2.2 skrll break;
1493 1.1.2.2 skrll
1494 1.1.2.2 skrll #ifdef RTW_DEBUG
1495 1.1.2.2 skrll #define PRINTINTR(flag) do { \
1496 1.1.2.2 skrll if ((isr & flag) != 0) { \
1497 1.1.2.2 skrll printf("%s" #flag, delim); \
1498 1.1.2.2 skrll delim = ","; \
1499 1.1.2.2 skrll } \
1500 1.1.2.2 skrll } while (0)
1501 1.1.2.2 skrll
1502 1.1.2.2 skrll if (rtw_debug > 1 && isr != 0) {
1503 1.1.2.2 skrll const char *delim = "<";
1504 1.1.2.2 skrll
1505 1.1.2.2 skrll printf("%s: reg[ISR] = %x", sc->sc_dev.dv_xname, isr);
1506 1.1.2.2 skrll
1507 1.1.2.2 skrll PRINTINTR(RTW_INTR_TXFOVW);
1508 1.1.2.2 skrll PRINTINTR(RTW_INTR_TIMEOUT);
1509 1.1.2.2 skrll PRINTINTR(RTW_INTR_BCNINT);
1510 1.1.2.2 skrll PRINTINTR(RTW_INTR_ATIMINT);
1511 1.1.2.2 skrll PRINTINTR(RTW_INTR_TBDER);
1512 1.1.2.2 skrll PRINTINTR(RTW_INTR_TBDOK);
1513 1.1.2.2 skrll PRINTINTR(RTW_INTR_THPDER);
1514 1.1.2.2 skrll PRINTINTR(RTW_INTR_THPDOK);
1515 1.1.2.2 skrll PRINTINTR(RTW_INTR_TNPDER);
1516 1.1.2.2 skrll PRINTINTR(RTW_INTR_TNPDOK);
1517 1.1.2.2 skrll PRINTINTR(RTW_INTR_RXFOVW);
1518 1.1.2.2 skrll PRINTINTR(RTW_INTR_RDU);
1519 1.1.2.2 skrll PRINTINTR(RTW_INTR_TLPDER);
1520 1.1.2.2 skrll PRINTINTR(RTW_INTR_TLPDOK);
1521 1.1.2.2 skrll PRINTINTR(RTW_INTR_RER);
1522 1.1.2.2 skrll PRINTINTR(RTW_INTR_ROK);
1523 1.1.2.2 skrll
1524 1.1.2.2 skrll printf(">\n");
1525 1.1.2.2 skrll }
1526 1.1.2.2 skrll #undef PRINTINTR
1527 1.1.2.2 skrll #endif /* RTW_DEBUG */
1528 1.1.2.2 skrll
1529 1.1.2.2 skrll if ((isr & RTW_INTR_RX) != 0)
1530 1.1.2.2 skrll rtw_intr_rx(sc, isr & RTW_INTR_RX);
1531 1.1.2.2 skrll if ((isr & RTW_INTR_TX) != 0)
1532 1.1.2.2 skrll rtw_intr_tx(sc, isr & RTW_INTR_TX);
1533 1.1.2.2 skrll if ((isr & RTW_INTR_BEACON) != 0)
1534 1.1.2.2 skrll rtw_intr_beacon(sc, isr & RTW_INTR_BEACON);
1535 1.1.2.2 skrll if ((isr & RTW_INTR_ATIMINT) != 0)
1536 1.1.2.2 skrll rtw_intr_atim(sc);
1537 1.1.2.2 skrll if ((isr & RTW_INTR_IOERROR) != 0)
1538 1.1.2.2 skrll rtw_intr_ioerror(sc, isr & RTW_INTR_IOERROR);
1539 1.1.2.2 skrll if ((isr & RTW_INTR_TIMEOUT) != 0)
1540 1.1.2.2 skrll rtw_intr_timeout(sc);
1541 1.1.2.2 skrll }
1542 1.1.2.2 skrll
1543 1.1.2.2 skrll return 1;
1544 1.1.2.2 skrll }
1545 1.1.2.2 skrll
1546 1.1.2.2 skrll static void
1547 1.1.2.2 skrll rtw_stop(struct ifnet *ifp, int disable)
1548 1.1.2.2 skrll {
1549 1.1.2.4 skrll int s;
1550 1.1.2.2 skrll struct rtw_softc *sc = (struct rtw_softc *)ifp->if_softc;
1551 1.1.2.2 skrll struct ieee80211com *ic = &sc->sc_ic;
1552 1.1.2.2 skrll struct rtw_regs *regs = &sc->sc_regs;
1553 1.1.2.2 skrll
1554 1.1.2.4 skrll if ((sc->sc_flags & RTW_F_ENABLED) == 0)
1555 1.1.2.4 skrll return;
1556 1.1.2.4 skrll
1557 1.1.2.2 skrll rtw_suspend_ticks(sc);
1558 1.1.2.2 skrll
1559 1.1.2.4 skrll s = splnet();
1560 1.1.2.4 skrll
1561 1.1.2.2 skrll ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
1562 1.1.2.2 skrll
1563 1.1.2.4 skrll if ((sc->sc_flags & RTW_F_INVALID) == 0) {
1564 1.1.2.4 skrll /* Disable interrupts. */
1565 1.1.2.4 skrll RTW_WRITE16(regs, RTW_IMR, 0);
1566 1.1.2.4 skrll
1567 1.1.2.4 skrll /* Stop the transmit and receive processes. First stop DMA,
1568 1.1.2.4 skrll * then disable receiver and transmitter.
1569 1.1.2.4 skrll */
1570 1.1.2.4 skrll RTW_WRITE8(regs, RTW_TPPOLL,
1571 1.1.2.4 skrll RTW_TPPOLL_SBQ|RTW_TPPOLL_SHPQ|RTW_TPPOLL_SNPQ|
1572 1.1.2.4 skrll RTW_TPPOLL_SLPQ);
1573 1.1.2.2 skrll
1574 1.1.2.4 skrll rtw_io_enable(&sc->sc_regs, RTW_CR_RE|RTW_CR_TE, 0);
1575 1.1.2.4 skrll }
1576 1.1.2.2 skrll
1577 1.1.2.2 skrll /* TBD Release transmit buffers. */
1578 1.1.2.2 skrll
1579 1.1.2.2 skrll if (disable) {
1580 1.1.2.2 skrll rtw_disable(sc);
1581 1.1.2.2 skrll rtw_rxbufs_release(sc->sc_dmat, &sc->sc_rxctl[0]);
1582 1.1.2.2 skrll }
1583 1.1.2.2 skrll
1584 1.1.2.2 skrll /* Mark the interface as not running. Cancel the watchdog timer. */
1585 1.1.2.2 skrll ifp->if_flags &= ~IFF_RUNNING;
1586 1.1.2.2 skrll ifp->if_timer = 0;
1587 1.1.2.4 skrll
1588 1.1.2.4 skrll splx(s);
1589 1.1.2.4 skrll
1590 1.1.2.2 skrll return;
1591 1.1.2.2 skrll }
1592 1.1.2.2 skrll
1593 1.1.2.2 skrll const char *
1594 1.1.2.2 skrll rtw_pwrstate_string(enum rtw_pwrstate power)
1595 1.1.2.2 skrll {
1596 1.1.2.2 skrll switch (power) {
1597 1.1.2.2 skrll case RTW_ON:
1598 1.1.2.2 skrll return "on";
1599 1.1.2.2 skrll case RTW_SLEEP:
1600 1.1.2.2 skrll return "sleep";
1601 1.1.2.2 skrll case RTW_OFF:
1602 1.1.2.2 skrll return "off";
1603 1.1.2.2 skrll default:
1604 1.1.2.2 skrll return "unknown";
1605 1.1.2.2 skrll }
1606 1.1.2.2 skrll }
1607 1.1.2.2 skrll
1608 1.1.2.2 skrll /* XXX I am using the RFMD settings gleaned from the reference
1609 1.1.2.2 skrll * driver.
1610 1.1.2.2 skrll */
1611 1.1.2.2 skrll static void
1612 1.1.2.2 skrll rtw_maxim_pwrstate(struct rtw_regs *regs, enum rtw_pwrstate power,
1613 1.1.2.2 skrll int before_rf)
1614 1.1.2.2 skrll {
1615 1.1.2.2 skrll u_int32_t anaparm;
1616 1.1.2.2 skrll
1617 1.1.2.2 skrll RTW_DPRINTF(("%s: power state %s, %s RF\n", __func__,
1618 1.1.2.2 skrll rtw_pwrstate_string(power), (before_rf) ? "before" : "after"));
1619 1.1.2.2 skrll
1620 1.1.2.2 skrll anaparm = RTW_READ(regs, RTW_ANAPARM);
1621 1.1.2.2 skrll anaparm &= ~(RTW_ANAPARM_RFPOW0_MASK|RTW_ANAPARM_RFPOW1_MASK);
1622 1.1.2.2 skrll anaparm &= ~RTW_ANAPARM_TXDACOFF;
1623 1.1.2.2 skrll
1624 1.1.2.2 skrll switch (power) {
1625 1.1.2.2 skrll case RTW_OFF:
1626 1.1.2.2 skrll if (before_rf)
1627 1.1.2.2 skrll return;
1628 1.1.2.2 skrll anaparm |= RTW_ANAPARM_RFPOW0_RFMD_OFF;
1629 1.1.2.2 skrll anaparm |= RTW_ANAPARM_RFPOW1_RFMD_OFF;
1630 1.1.2.2 skrll anaparm |= RTW_ANAPARM_TXDACOFF;
1631 1.1.2.2 skrll break;
1632 1.1.2.2 skrll case RTW_SLEEP:
1633 1.1.2.2 skrll if (!before_rf)
1634 1.1.2.2 skrll return;
1635 1.1.2.2 skrll anaparm |= RTW_ANAPARM_RFPOW0_RFMD_SLEEP;
1636 1.1.2.2 skrll anaparm |= RTW_ANAPARM_RFPOW1_RFMD_SLEEP;
1637 1.1.2.2 skrll anaparm |= RTW_ANAPARM_TXDACOFF;
1638 1.1.2.2 skrll break;
1639 1.1.2.2 skrll case RTW_ON:
1640 1.1.2.2 skrll if (!before_rf)
1641 1.1.2.2 skrll return;
1642 1.1.2.2 skrll anaparm |= RTW_ANAPARM_RFPOW0_RFMD_ON;
1643 1.1.2.2 skrll anaparm |= RTW_ANAPARM_RFPOW1_RFMD_ON;
1644 1.1.2.2 skrll break;
1645 1.1.2.2 skrll }
1646 1.1.2.2 skrll RTW_WRITE(regs, RTW_ANAPARM, anaparm);
1647 1.1.2.2 skrll RTW_SYNC(regs, RTW_ANAPARM, RTW_ANAPARM);
1648 1.1.2.2 skrll }
1649 1.1.2.2 skrll
1650 1.1.2.2 skrll static void
1651 1.1.2.2 skrll rtw_philips_pwrstate(struct rtw_regs *regs, enum rtw_pwrstate power,
1652 1.1.2.2 skrll int before_rf)
1653 1.1.2.2 skrll {
1654 1.1.2.2 skrll u_int32_t anaparm;
1655 1.1.2.2 skrll
1656 1.1.2.2 skrll RTW_DPRINTF(("%s: power state %s, %s RF\n", __func__,
1657 1.1.2.2 skrll rtw_pwrstate_string(power), (before_rf) ? "before" : "after"));
1658 1.1.2.2 skrll
1659 1.1.2.2 skrll anaparm = RTW_READ(regs, RTW_ANAPARM);
1660 1.1.2.2 skrll anaparm &= ~(RTW_ANAPARM_RFPOW0_MASK|RTW_ANAPARM_RFPOW1_MASK);
1661 1.1.2.2 skrll anaparm &= ~RTW_ANAPARM_TXDACOFF;
1662 1.1.2.2 skrll
1663 1.1.2.2 skrll switch (power) {
1664 1.1.2.2 skrll case RTW_OFF:
1665 1.1.2.2 skrll if (before_rf)
1666 1.1.2.2 skrll return;
1667 1.1.2.2 skrll anaparm |= RTW_ANAPARM_RFPOW0_PHILIPS_OFF;
1668 1.1.2.2 skrll anaparm |= RTW_ANAPARM_RFPOW1_PHILIPS_OFF;
1669 1.1.2.2 skrll anaparm |= RTW_ANAPARM_TXDACOFF;
1670 1.1.2.2 skrll break;
1671 1.1.2.2 skrll case RTW_SLEEP:
1672 1.1.2.2 skrll if (!before_rf)
1673 1.1.2.2 skrll return;
1674 1.1.2.2 skrll anaparm |= RTW_ANAPARM_RFPOW0_PHILIPS_SLEEP;
1675 1.1.2.2 skrll anaparm |= RTW_ANAPARM_RFPOW1_PHILIPS_SLEEP;
1676 1.1.2.2 skrll anaparm |= RTW_ANAPARM_TXDACOFF;
1677 1.1.2.2 skrll break;
1678 1.1.2.2 skrll case RTW_ON:
1679 1.1.2.2 skrll if (!before_rf)
1680 1.1.2.2 skrll return;
1681 1.1.2.2 skrll anaparm |= RTW_ANAPARM_RFPOW0_PHILIPS_ON;
1682 1.1.2.2 skrll anaparm |= RTW_ANAPARM_RFPOW1_PHILIPS_ON;
1683 1.1.2.2 skrll break;
1684 1.1.2.2 skrll }
1685 1.1.2.2 skrll RTW_WRITE(regs, RTW_ANAPARM, anaparm);
1686 1.1.2.2 skrll RTW_SYNC(regs, RTW_ANAPARM, RTW_ANAPARM);
1687 1.1.2.2 skrll }
1688 1.1.2.2 skrll
1689 1.1.2.2 skrll static void
1690 1.1.2.2 skrll rtw_pwrstate0(struct rtw_softc *sc, enum rtw_pwrstate power, int before_rf)
1691 1.1.2.2 skrll {
1692 1.1.2.2 skrll struct rtw_regs *regs = &sc->sc_regs;
1693 1.1.2.2 skrll
1694 1.1.2.4 skrll rtw_set_access(sc, RTW_ACCESS_ANAPARM);
1695 1.1.2.2 skrll
1696 1.1.2.2 skrll (*sc->sc_pwrstate_cb)(regs, power, before_rf);
1697 1.1.2.2 skrll
1698 1.1.2.4 skrll rtw_set_access(sc, RTW_ACCESS_NONE);
1699 1.1.2.2 skrll
1700 1.1.2.2 skrll return;
1701 1.1.2.2 skrll }
1702 1.1.2.2 skrll
1703 1.1.2.2 skrll static int
1704 1.1.2.2 skrll rtw_pwrstate(struct rtw_softc *sc, enum rtw_pwrstate power)
1705 1.1.2.2 skrll {
1706 1.1.2.2 skrll int rc;
1707 1.1.2.2 skrll
1708 1.1.2.2 skrll RTW_DPRINTF2(("%s: %s->%s\n", __func__,
1709 1.1.2.2 skrll rtw_pwrstate_string(sc->sc_pwrstate), rtw_pwrstate_string(power)));
1710 1.1.2.2 skrll
1711 1.1.2.2 skrll if (sc->sc_pwrstate == power)
1712 1.1.2.2 skrll return 0;
1713 1.1.2.2 skrll
1714 1.1.2.2 skrll rtw_pwrstate0(sc, power, 1);
1715 1.1.2.2 skrll rc = rtw_rf_pwrstate(sc->sc_rf, power);
1716 1.1.2.2 skrll rtw_pwrstate0(sc, power, 0);
1717 1.1.2.2 skrll
1718 1.1.2.2 skrll switch (power) {
1719 1.1.2.2 skrll case RTW_ON:
1720 1.1.2.4 skrll /* TBD set LEDs */
1721 1.1.2.2 skrll break;
1722 1.1.2.2 skrll case RTW_SLEEP:
1723 1.1.2.2 skrll /* TBD */
1724 1.1.2.2 skrll break;
1725 1.1.2.2 skrll case RTW_OFF:
1726 1.1.2.2 skrll /* TBD */
1727 1.1.2.2 skrll break;
1728 1.1.2.2 skrll }
1729 1.1.2.2 skrll if (rc == 0)
1730 1.1.2.2 skrll sc->sc_pwrstate = power;
1731 1.1.2.2 skrll else
1732 1.1.2.2 skrll sc->sc_pwrstate = RTW_OFF;
1733 1.1.2.2 skrll return rc;
1734 1.1.2.2 skrll }
1735 1.1.2.2 skrll
1736 1.1.2.2 skrll static int
1737 1.1.2.2 skrll rtw_tune(struct rtw_softc *sc)
1738 1.1.2.2 skrll {
1739 1.1.2.2 skrll struct ieee80211com *ic = &sc->sc_ic;
1740 1.1.2.2 skrll u_int chan;
1741 1.1.2.2 skrll int rc;
1742 1.1.2.2 skrll int antdiv = sc->sc_flags & RTW_F_ANTDIV,
1743 1.1.2.2 skrll dflantb = sc->sc_flags & RTW_F_DFLANTB;
1744 1.1.2.2 skrll
1745 1.1.2.2 skrll KASSERT(ic->ic_bss->ni_chan != NULL);
1746 1.1.2.2 skrll
1747 1.1.2.2 skrll chan = ieee80211_chan2ieee(ic, ic->ic_bss->ni_chan);
1748 1.1.2.2 skrll if (chan == IEEE80211_CHAN_ANY)
1749 1.1.2.2 skrll panic("%s: chan == IEEE80211_CHAN_ANY\n", __func__);
1750 1.1.2.2 skrll
1751 1.1.2.2 skrll if (chan == sc->sc_cur_chan) {
1752 1.1.2.2 skrll RTW_DPRINTF(("%s: already tuned chan #%d\n", __func__, chan));
1753 1.1.2.2 skrll return 0;
1754 1.1.2.2 skrll }
1755 1.1.2.2 skrll
1756 1.1.2.2 skrll rtw_suspend_ticks(sc);
1757 1.1.2.2 skrll
1758 1.1.2.2 skrll rtw_io_enable(&sc->sc_regs, RTW_CR_RE | RTW_CR_TE, 0);
1759 1.1.2.2 skrll
1760 1.1.2.2 skrll /* TBD wait for Tx to complete */
1761 1.1.2.2 skrll
1762 1.1.2.2 skrll KASSERT((sc->sc_flags & RTW_F_ENABLED) != 0);
1763 1.1.2.2 skrll
1764 1.1.2.2 skrll if ((rc = rtw_phy_init(&sc->sc_regs, sc->sc_rf,
1765 1.1.2.2 skrll rtw_chan2txpower(&sc->sc_srom, ic, ic->ic_bss->ni_chan),
1766 1.1.2.2 skrll sc->sc_csthr, ic->ic_bss->ni_chan->ic_freq, antdiv,
1767 1.1.2.2 skrll dflantb, RTW_ON)) != 0) {
1768 1.1.2.2 skrll /* XXX condition on powersaving */
1769 1.1.2.2 skrll printf("%s: phy init failed\n", sc->sc_dev.dv_xname);
1770 1.1.2.2 skrll }
1771 1.1.2.2 skrll
1772 1.1.2.2 skrll sc->sc_cur_chan = chan;
1773 1.1.2.2 skrll
1774 1.1.2.2 skrll rtw_io_enable(&sc->sc_regs, RTW_CR_RE | RTW_CR_TE, 1);
1775 1.1.2.2 skrll
1776 1.1.2.2 skrll rtw_resume_ticks(sc);
1777 1.1.2.2 skrll
1778 1.1.2.2 skrll return rc;
1779 1.1.2.2 skrll }
1780 1.1.2.2 skrll
1781 1.1.2.2 skrll void
1782 1.1.2.2 skrll rtw_disable(struct rtw_softc *sc)
1783 1.1.2.2 skrll {
1784 1.1.2.2 skrll int rc;
1785 1.1.2.2 skrll
1786 1.1.2.2 skrll if ((sc->sc_flags & RTW_F_ENABLED) == 0)
1787 1.1.2.2 skrll return;
1788 1.1.2.2 skrll
1789 1.1.2.2 skrll /* turn off PHY */
1790 1.1.2.2 skrll if ((rc = rtw_pwrstate(sc, RTW_OFF)) != 0)
1791 1.1.2.2 skrll printf("%s: failed to turn off PHY (%d)\n",
1792 1.1.2.2 skrll sc->sc_dev.dv_xname, rc);
1793 1.1.2.2 skrll
1794 1.1.2.2 skrll if (sc->sc_disable != NULL)
1795 1.1.2.2 skrll (*sc->sc_disable)(sc);
1796 1.1.2.2 skrll
1797 1.1.2.2 skrll sc->sc_flags &= ~RTW_F_ENABLED;
1798 1.1.2.2 skrll }
1799 1.1.2.2 skrll
1800 1.1.2.2 skrll int
1801 1.1.2.2 skrll rtw_enable(struct rtw_softc *sc)
1802 1.1.2.2 skrll {
1803 1.1.2.2 skrll if ((sc->sc_flags & RTW_F_ENABLED) == 0) {
1804 1.1.2.2 skrll if (sc->sc_enable != NULL && (*sc->sc_enable)(sc) != 0) {
1805 1.1.2.2 skrll printf("%s: device enable failed\n",
1806 1.1.2.2 skrll sc->sc_dev.dv_xname);
1807 1.1.2.2 skrll return (EIO);
1808 1.1.2.2 skrll }
1809 1.1.2.2 skrll sc->sc_flags |= RTW_F_ENABLED;
1810 1.1.2.2 skrll }
1811 1.1.2.2 skrll return (0);
1812 1.1.2.2 skrll }
1813 1.1.2.2 skrll
1814 1.1.2.2 skrll static void
1815 1.1.2.2 skrll rtw_transmit_config(struct rtw_regs *regs)
1816 1.1.2.2 skrll {
1817 1.1.2.2 skrll u_int32_t tcr;
1818 1.1.2.2 skrll
1819 1.1.2.2 skrll tcr = RTW_READ(regs, RTW_TCR);
1820 1.1.2.2 skrll
1821 1.1.2.2 skrll tcr |= RTW_TCR_SAT; /* send ACK as fast as possible */
1822 1.1.2.2 skrll tcr &= ~RTW_TCR_LBK_MASK;
1823 1.1.2.2 skrll tcr |= RTW_TCR_LBK_NORMAL; /* normal operating mode */
1824 1.1.2.2 skrll
1825 1.1.2.2 skrll /* set short/long retry limits */
1826 1.1.2.2 skrll tcr &= ~(RTW_TCR_SRL_MASK|RTW_TCR_LRL_MASK);
1827 1.1.2.2 skrll tcr |= LSHIFT(7, RTW_TCR_SRL_MASK) | LSHIFT(7, RTW_TCR_LRL_MASK);
1828 1.1.2.2 skrll
1829 1.1.2.2 skrll tcr |= RTW_TCR_CRC; /* NIC appends CRC32 */
1830 1.1.2.2 skrll
1831 1.1.2.2 skrll RTW_WRITE(regs, RTW_TCR, tcr);
1832 1.1.2.2 skrll }
1833 1.1.2.2 skrll
1834 1.1.2.2 skrll static __inline void
1835 1.1.2.2 skrll rtw_enable_interrupts(struct rtw_softc *sc)
1836 1.1.2.2 skrll {
1837 1.1.2.2 skrll struct rtw_regs *regs = &sc->sc_regs;
1838 1.1.2.2 skrll
1839 1.1.2.2 skrll sc->sc_inten = RTW_INTR_RX|RTW_INTR_TX|RTW_INTR_BEACON|RTW_INTR_ATIMINT;
1840 1.1.2.2 skrll sc->sc_inten |= RTW_INTR_IOERROR|RTW_INTR_TIMEOUT;
1841 1.1.2.2 skrll
1842 1.1.2.2 skrll RTW_WRITE16(regs, RTW_IMR, sc->sc_inten);
1843 1.1.2.2 skrll RTW_WRITE16(regs, RTW_ISR, 0xffff);
1844 1.1.2.2 skrll
1845 1.1.2.2 skrll /* XXX necessary? */
1846 1.1.2.2 skrll if (sc->sc_intr_ack != NULL)
1847 1.1.2.2 skrll (*sc->sc_intr_ack)(regs);
1848 1.1.2.2 skrll }
1849 1.1.2.2 skrll
1850 1.1.2.2 skrll /* XXX is the endianness correct? test. */
1851 1.1.2.2 skrll #define rtw_calchash(addr) \
1852 1.1.2.2 skrll (ether_crc32_le((addr), IEEE80211_ADDR_LEN) & BITS(5, 0))
1853 1.1.2.2 skrll
1854 1.1.2.2 skrll static void
1855 1.1.2.2 skrll rtw_pktfilt_load(struct rtw_softc *sc)
1856 1.1.2.2 skrll {
1857 1.1.2.2 skrll struct rtw_regs *regs = &sc->sc_regs;
1858 1.1.2.2 skrll struct ieee80211com *ic = &sc->sc_ic;
1859 1.1.2.2 skrll struct ethercom *ec = &ic->ic_ec;
1860 1.1.2.2 skrll struct ifnet *ifp = &sc->sc_ic.ic_if;
1861 1.1.2.2 skrll int hash;
1862 1.1.2.2 skrll u_int32_t hashes[2] = { 0, 0 };
1863 1.1.2.2 skrll struct ether_multi *enm;
1864 1.1.2.2 skrll struct ether_multistep step;
1865 1.1.2.2 skrll
1866 1.1.2.2 skrll /* XXX might be necessary to stop Rx/Tx engines while setting filters */
1867 1.1.2.2 skrll
1868 1.1.2.2 skrll #define RTW_RCR_MONITOR (RTW_RCR_ACRC32|RTW_RCR_APM|RTW_RCR_AAP|RTW_RCR_AB)
1869 1.1.2.2 skrll
1870 1.1.2.2 skrll if (ic->ic_opmode == IEEE80211_M_MONITOR)
1871 1.1.2.2 skrll sc->sc_rcr |= RTW_RCR_MONITOR;
1872 1.1.2.2 skrll else
1873 1.1.2.2 skrll sc->sc_rcr &= ~RTW_RCR_MONITOR;
1874 1.1.2.2 skrll
1875 1.1.2.2 skrll /* XXX reference sources BEGIN */
1876 1.1.2.2 skrll sc->sc_rcr |= RTW_RCR_ENMARP | RTW_RCR_AICV | RTW_RCR_ACRC32;
1877 1.1.2.2 skrll sc->sc_rcr |= RTW_RCR_AB | RTW_RCR_AM | RTW_RCR_APM;
1878 1.1.2.2 skrll #if 0
1879 1.1.2.2 skrll /* receive broadcasts in our BSS */
1880 1.1.2.2 skrll sc->sc_rcr |= RTW_RCR_ADD3;
1881 1.1.2.2 skrll #endif
1882 1.1.2.2 skrll /* XXX reference sources END */
1883 1.1.2.2 skrll
1884 1.1.2.2 skrll /* receive pwrmgmt frames. */
1885 1.1.2.2 skrll sc->sc_rcr |= RTW_RCR_APWRMGT;
1886 1.1.2.2 skrll /* receive mgmt/ctrl/data frames. */
1887 1.1.2.2 skrll sc->sc_rcr |= RTW_RCR_AMF | RTW_RCR_ACF | RTW_RCR_ADF;
1888 1.1.2.2 skrll /* initialize Rx DMA threshold, Tx DMA burst size */
1889 1.1.2.2 skrll sc->sc_rcr |= RTW_RCR_RXFTH_WHOLE | RTW_RCR_MXDMA_1024;
1890 1.1.2.2 skrll
1891 1.1.2.2 skrll ifp->if_flags &= ~IFF_ALLMULTI;
1892 1.1.2.2 skrll
1893 1.1.2.2 skrll if (ifp->if_flags & IFF_PROMISC) {
1894 1.1.2.2 skrll sc->sc_rcr |= RTW_RCR_AB; /* accept all broadcast */
1895 1.1.2.2 skrll allmulti:
1896 1.1.2.2 skrll ifp->if_flags |= IFF_ALLMULTI;
1897 1.1.2.2 skrll goto setit;
1898 1.1.2.2 skrll }
1899 1.1.2.2 skrll
1900 1.1.2.2 skrll /*
1901 1.1.2.2 skrll * Program the 64-bit multicast hash filter.
1902 1.1.2.2 skrll */
1903 1.1.2.2 skrll ETHER_FIRST_MULTI(step, ec, enm);
1904 1.1.2.2 skrll while (enm != NULL) {
1905 1.1.2.2 skrll /* XXX */
1906 1.1.2.2 skrll if (memcmp(enm->enm_addrlo, enm->enm_addrhi,
1907 1.1.2.2 skrll ETHER_ADDR_LEN) != 0)
1908 1.1.2.2 skrll goto allmulti;
1909 1.1.2.2 skrll
1910 1.1.2.2 skrll hash = rtw_calchash(enm->enm_addrlo);
1911 1.1.2.2 skrll hashes[hash >> 5] |= 1 << (hash & 0x1f);
1912 1.1.2.2 skrll ETHER_NEXT_MULTI(step, enm);
1913 1.1.2.2 skrll }
1914 1.1.2.2 skrll
1915 1.1.2.2 skrll if (ifp->if_flags & IFF_BROADCAST) {
1916 1.1.2.2 skrll hash = rtw_calchash(etherbroadcastaddr);
1917 1.1.2.2 skrll hashes[hash >> 5] |= 1 << (hash & 0x1f);
1918 1.1.2.2 skrll }
1919 1.1.2.2 skrll
1920 1.1.2.2 skrll /* all bits set => hash is useless */
1921 1.1.2.2 skrll if (~(hashes[0] & hashes[1]) == 0)
1922 1.1.2.2 skrll goto allmulti;
1923 1.1.2.2 skrll
1924 1.1.2.2 skrll setit:
1925 1.1.2.2 skrll if (ifp->if_flags & IFF_ALLMULTI)
1926 1.1.2.2 skrll sc->sc_rcr |= RTW_RCR_AM; /* accept all multicast */
1927 1.1.2.2 skrll
1928 1.1.2.2 skrll if (ic->ic_state == IEEE80211_S_SCAN)
1929 1.1.2.2 skrll sc->sc_rcr |= RTW_RCR_AB; /* accept all broadcast */
1930 1.1.2.2 skrll
1931 1.1.2.2 skrll hashes[0] = hashes[1] = 0xffffffff;
1932 1.1.2.2 skrll
1933 1.1.2.2 skrll RTW_WRITE(regs, RTW_MAR0, hashes[0]);
1934 1.1.2.2 skrll RTW_WRITE(regs, RTW_MAR1, hashes[1]);
1935 1.1.2.2 skrll RTW_WRITE(regs, RTW_RCR, sc->sc_rcr);
1936 1.1.2.2 skrll RTW_SYNC(regs, RTW_MAR0, RTW_RCR); /* RTW_MAR0 < RTW_MAR1 < RTW_RCR */
1937 1.1.2.2 skrll
1938 1.1.2.2 skrll DPRINTF(sc, ("%s: RTW_MAR0 %08x RTW_MAR1 %08x RTW_RCR %08x\n",
1939 1.1.2.2 skrll sc->sc_dev.dv_xname, RTW_READ(regs, RTW_MAR0),
1940 1.1.2.2 skrll RTW_READ(regs, RTW_MAR1), RTW_READ(regs, RTW_RCR)));
1941 1.1.2.2 skrll
1942 1.1.2.2 skrll return;
1943 1.1.2.2 skrll }
1944 1.1.2.2 skrll
1945 1.1.2.2 skrll static int
1946 1.1.2.2 skrll rtw_init(struct ifnet *ifp)
1947 1.1.2.2 skrll {
1948 1.1.2.2 skrll struct rtw_softc *sc = (struct rtw_softc *)ifp->if_softc;
1949 1.1.2.2 skrll struct ieee80211com *ic = &sc->sc_ic;
1950 1.1.2.2 skrll struct rtw_regs *regs = &sc->sc_regs;
1951 1.1.2.4 skrll int rc = 0;
1952 1.1.2.2 skrll
1953 1.1.2.2 skrll if ((rc = rtw_enable(sc)) != 0)
1954 1.1.2.2 skrll goto out;
1955 1.1.2.2 skrll
1956 1.1.2.2 skrll /* Cancel pending I/O and reset. */
1957 1.1.2.2 skrll rtw_stop(ifp, 0);
1958 1.1.2.2 skrll
1959 1.1.2.2 skrll ic->ic_bss->ni_chan = ic->ic_ibss_chan;
1960 1.1.2.2 skrll DPRINTF(sc, ("%s: channel %d freq %d flags 0x%04x\n",
1961 1.1.2.2 skrll __func__, ieee80211_chan2ieee(ic, ic->ic_bss->ni_chan),
1962 1.1.2.2 skrll ic->ic_bss->ni_chan->ic_freq, ic->ic_bss->ni_chan->ic_flags));
1963 1.1.2.2 skrll
1964 1.1.2.2 skrll if ((rc = rtw_pwrstate(sc, RTW_OFF)) != 0)
1965 1.1.2.2 skrll goto out;
1966 1.1.2.2 skrll
1967 1.1.2.4 skrll rtw_swring_setup(sc);
1968 1.1.2.2 skrll
1969 1.1.2.2 skrll rtw_transmit_config(regs);
1970 1.1.2.2 skrll
1971 1.1.2.4 skrll rtw_set_access(sc, RTW_ACCESS_CONFIG);
1972 1.1.2.2 skrll
1973 1.1.2.4 skrll RTW_WRITE8(regs, RTW_MSR, 0x0); /* no link */
1974 1.1.2.2 skrll
1975 1.1.2.4 skrll /* long PLCP header, 1Mbps basic rate */
1976 1.1.2.4 skrll RTW_WRITE16(regs, RTW_BRSR, 0x0);
1977 1.1.2.2 skrll
1978 1.1.2.4 skrll rtw_set_access(sc, RTW_ACCESS_ANAPARM);
1979 1.1.2.4 skrll rtw_set_access(sc, RTW_ACCESS_NONE);
1980 1.1.2.2 skrll
1981 1.1.2.2 skrll #if 0
1982 1.1.2.2 skrll RTW_WRITE(regs, RTW_FEMR, RTW_FEMR_GWAKE|RTW_FEMR_WKUP|RTW_FEMR_INTR);
1983 1.1.2.2 skrll #endif
1984 1.1.2.2 skrll /* XXX from reference sources */
1985 1.1.2.2 skrll RTW_WRITE(regs, RTW_FEMR, 0xffff);
1986 1.1.2.2 skrll
1987 1.1.2.4 skrll rtw_set_rfprog(regs, sc->sc_rfchipid, sc->sc_dev.dv_xname);
1988 1.1.2.4 skrll
1989 1.1.2.4 skrll RTW_WRITE8(regs, RTW_PHYDELAY, sc->sc_phydelay);
1990 1.1.2.2 skrll /* from Linux driver */
1991 1.1.2.4 skrll RTW_WRITE8(regs, RTW_CRCOUNT, RTW_CRCOUNT_MAGIC);
1992 1.1.2.2 skrll
1993 1.1.2.2 skrll rtw_enable_interrupts(sc);
1994 1.1.2.2 skrll
1995 1.1.2.2 skrll rtw_pktfilt_load(sc);
1996 1.1.2.2 skrll
1997 1.1.2.4 skrll rtw_hwring_setup(sc);
1998 1.1.2.2 skrll
1999 1.1.2.2 skrll rtw_io_enable(regs, RTW_CR_RE|RTW_CR_TE, 1);
2000 1.1.2.2 skrll
2001 1.1.2.2 skrll ifp->if_flags |= IFF_RUNNING;
2002 1.1.2.2 skrll ic->ic_state = IEEE80211_S_INIT;
2003 1.1.2.2 skrll
2004 1.1.2.2 skrll RTW_WRITE16(regs, RTW_BSSID16, 0x0);
2005 1.1.2.2 skrll RTW_WRITE(regs, RTW_BSSID32, 0x0);
2006 1.1.2.2 skrll
2007 1.1.2.2 skrll rtw_resume_ticks(sc);
2008 1.1.2.2 skrll
2009 1.1.2.4 skrll /* I'm guessing that MSR is protected as CONFIG[0123] are. */
2010 1.1.2.4 skrll rtw_set_access(sc, RTW_ACCESS_CONFIG);
2011 1.1.2.4 skrll
2012 1.1.2.2 skrll switch (ic->ic_opmode) {
2013 1.1.2.2 skrll case IEEE80211_M_AHDEMO:
2014 1.1.2.2 skrll case IEEE80211_M_IBSS:
2015 1.1.2.2 skrll RTW_WRITE8(regs, RTW_MSR, RTW_MSR_NETYPE_ADHOC_OK);
2016 1.1.2.2 skrll break;
2017 1.1.2.2 skrll case IEEE80211_M_HOSTAP:
2018 1.1.2.2 skrll RTW_WRITE8(regs, RTW_MSR, RTW_MSR_NETYPE_AP_OK);
2019 1.1.2.4 skrll break;
2020 1.1.2.2 skrll case IEEE80211_M_MONITOR:
2021 1.1.2.2 skrll /* XXX */
2022 1.1.2.2 skrll RTW_WRITE8(regs, RTW_MSR, RTW_MSR_NETYPE_NOLINK);
2023 1.1.2.4 skrll break;
2024 1.1.2.2 skrll case IEEE80211_M_STA:
2025 1.1.2.2 skrll RTW_WRITE8(regs, RTW_MSR, RTW_MSR_NETYPE_INFRA_OK);
2026 1.1.2.2 skrll break;
2027 1.1.2.2 skrll }
2028 1.1.2.4 skrll
2029 1.1.2.4 skrll rtw_set_access(sc, RTW_ACCESS_NONE);
2030 1.1.2.4 skrll
2031 1.1.2.4 skrll if (ic->ic_opmode == IEEE80211_M_MONITOR)
2032 1.1.2.4 skrll return ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
2033 1.1.2.4 skrll else
2034 1.1.2.4 skrll return ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
2035 1.1.2.4 skrll
2036 1.1.2.2 skrll out:
2037 1.1.2.2 skrll return rc;
2038 1.1.2.2 skrll }
2039 1.1.2.2 skrll
2040 1.1.2.2 skrll static int
2041 1.1.2.2 skrll rtw_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
2042 1.1.2.2 skrll {
2043 1.1.2.2 skrll int rc = 0;
2044 1.1.2.2 skrll struct rtw_softc *sc = ifp->if_softc;
2045 1.1.2.2 skrll struct ifreq *ifr = (struct ifreq *)data;
2046 1.1.2.2 skrll
2047 1.1.2.2 skrll switch (cmd) {
2048 1.1.2.2 skrll case SIOCSIFFLAGS:
2049 1.1.2.2 skrll if ((ifp->if_flags & IFF_UP) != 0) {
2050 1.1.2.2 skrll if ((sc->sc_flags & RTW_F_ENABLED) != 0) {
2051 1.1.2.2 skrll rtw_pktfilt_load(sc);
2052 1.1.2.2 skrll } else
2053 1.1.2.2 skrll rc = rtw_init(ifp);
2054 1.1.2.2 skrll #ifdef RTW_DEBUG
2055 1.1.2.2 skrll rtw_print_regs(&sc->sc_regs, ifp->if_xname, __func__);
2056 1.1.2.2 skrll #endif /* RTW_DEBUG */
2057 1.1.2.2 skrll } else if ((sc->sc_flags & RTW_F_ENABLED) != 0) {
2058 1.1.2.2 skrll #ifdef RTW_DEBUG
2059 1.1.2.2 skrll rtw_print_regs(&sc->sc_regs, ifp->if_xname, __func__);
2060 1.1.2.2 skrll #endif /* RTW_DEBUG */
2061 1.1.2.2 skrll rtw_stop(ifp, 1);
2062 1.1.2.2 skrll }
2063 1.1.2.2 skrll break;
2064 1.1.2.2 skrll case SIOCADDMULTI:
2065 1.1.2.2 skrll case SIOCDELMULTI:
2066 1.1.2.2 skrll if (cmd == SIOCADDMULTI)
2067 1.1.2.2 skrll rc = ether_addmulti(ifr, &sc->sc_ic.ic_ec);
2068 1.1.2.2 skrll else
2069 1.1.2.2 skrll rc = ether_delmulti(ifr, &sc->sc_ic.ic_ec);
2070 1.1.2.2 skrll if (rc == ENETRESET) {
2071 1.1.2.3 skrll if (ifp->if_flags & IFF_RUNNING)
2072 1.1.2.2 skrll rtw_pktfilt_load(sc);
2073 1.1.2.2 skrll rc = 0;
2074 1.1.2.2 skrll }
2075 1.1.2.2 skrll break;
2076 1.1.2.2 skrll default:
2077 1.1.2.2 skrll if ((rc = ieee80211_ioctl(ifp, cmd, data)) == ENETRESET) {
2078 1.1.2.2 skrll if ((sc->sc_flags & RTW_F_ENABLED) != 0)
2079 1.1.2.2 skrll rc = rtw_init(ifp);
2080 1.1.2.2 skrll else
2081 1.1.2.2 skrll rc = 0;
2082 1.1.2.2 skrll }
2083 1.1.2.2 skrll break;
2084 1.1.2.2 skrll }
2085 1.1.2.2 skrll return rc;
2086 1.1.2.2 skrll }
2087 1.1.2.2 skrll
2088 1.1.2.2 skrll /* Point *mp at the next 802.11 frame to transmit. Point *stcp
2089 1.1.2.2 skrll * at the driver's selection of transmit control block for the packet.
2090 1.1.2.2 skrll */
2091 1.1.2.2 skrll static __inline int
2092 1.1.2.2 skrll rtw_dequeue(struct ifnet *ifp, struct rtw_txctl_blk **stcp, struct mbuf **mp,
2093 1.1.2.2 skrll struct ieee80211_node **nip)
2094 1.1.2.2 skrll {
2095 1.1.2.2 skrll struct mbuf *m0;
2096 1.1.2.2 skrll struct rtw_softc *sc;
2097 1.1.2.2 skrll struct ieee80211com *ic;
2098 1.1.2.2 skrll
2099 1.1.2.2 skrll sc = (struct rtw_softc *)ifp->if_softc;
2100 1.1.2.2 skrll ic = &sc->sc_ic;
2101 1.1.2.2 skrll
2102 1.1.2.2 skrll *mp = NULL;
2103 1.1.2.2 skrll
2104 1.1.2.2 skrll if (!IF_IS_EMPTY(&ic->ic_mgtq)) {
2105 1.1.2.2 skrll IF_DEQUEUE(&ic->ic_mgtq, m0);
2106 1.1.2.2 skrll *nip = (struct ieee80211_node *)m0->m_pkthdr.rcvif;
2107 1.1.2.2 skrll m0->m_pkthdr.rcvif = NULL;
2108 1.1.2.2 skrll } else if (ic->ic_state != IEEE80211_S_RUN)
2109 1.1.2.2 skrll return 0;
2110 1.1.2.2 skrll else if (!IF_IS_EMPTY(&ic->ic_pwrsaveq)) {
2111 1.1.2.2 skrll IF_DEQUEUE(&ic->ic_pwrsaveq, m0);
2112 1.1.2.2 skrll *nip = (struct ieee80211_node *)m0->m_pkthdr.rcvif;
2113 1.1.2.2 skrll m0->m_pkthdr.rcvif = NULL;
2114 1.1.2.2 skrll } else {
2115 1.1.2.2 skrll IFQ_POLL(&ifp->if_snd, m0);
2116 1.1.2.2 skrll if (m0 == NULL)
2117 1.1.2.2 skrll return 0;
2118 1.1.2.2 skrll IFQ_DEQUEUE(&ifp->if_snd, m0);
2119 1.1.2.2 skrll ifp->if_opackets++;
2120 1.1.2.2 skrll #if NBPFILTER > 0
2121 1.1.2.2 skrll if (ifp->if_bpf)
2122 1.1.2.2 skrll bpf_mtap(ifp->if_bpf, m0);
2123 1.1.2.2 skrll #endif
2124 1.1.2.2 skrll if ((m0 = ieee80211_encap(ifp, m0, nip)) == NULL) {
2125 1.1.2.2 skrll ifp->if_oerrors++;
2126 1.1.2.2 skrll return -1;
2127 1.1.2.2 skrll }
2128 1.1.2.2 skrll }
2129 1.1.2.2 skrll *stcp = &sc->sc_txctl_blk[RTW_TXPRIMD];
2130 1.1.2.2 skrll *mp = m0;
2131 1.1.2.2 skrll return 0;
2132 1.1.2.2 skrll }
2133 1.1.2.2 skrll
2134 1.1.2.2 skrll static void
2135 1.1.2.2 skrll rtw_start(struct ifnet *ifp)
2136 1.1.2.2 skrll {
2137 1.1.2.2 skrll struct mbuf *m0;
2138 1.1.2.2 skrll struct rtw_softc *sc;
2139 1.1.2.2 skrll struct rtw_txctl_blk *stc;
2140 1.1.2.2 skrll struct ieee80211_node *ni;
2141 1.1.2.2 skrll
2142 1.1.2.2 skrll sc = (struct rtw_softc *)ifp->if_softc;
2143 1.1.2.2 skrll
2144 1.1.2.2 skrll #if 0
2145 1.1.2.2 skrll struct ifqueue ic_mgtq;
2146 1.1.2.2 skrll struct ifqueue ic_pwrsaveq;
2147 1.1.2.2 skrll struct rtw_txctl_blk {
2148 1.1.2.2 skrll /* dirty/free s/w descriptors */
2149 1.1.2.2 skrll struct rtw_txq stc_dirtyq;
2150 1.1.2.2 skrll struct rtw_txq stc_freeq;
2151 1.1.2.2 skrll u_int stc_ndesc;
2152 1.1.2.2 skrll struct rtw_txctl *stc_desc;
2153 1.1.2.2 skrll };
2154 1.1.2.2 skrll #endif
2155 1.1.2.2 skrll while (!SIMPLEQ_EMPTY(&stc->stc_freeq)) {
2156 1.1.2.2 skrll if (rtw_dequeue(ifp, &stc, &m0, &ni) == -1)
2157 1.1.2.2 skrll continue;
2158 1.1.2.2 skrll if (m0 == NULL)
2159 1.1.2.2 skrll break;
2160 1.1.2.2 skrll ieee80211_release_node(&sc->sc_ic, ni);
2161 1.1.2.2 skrll }
2162 1.1.2.2 skrll return;
2163 1.1.2.2 skrll }
2164 1.1.2.2 skrll
2165 1.1.2.2 skrll static void
2166 1.1.2.2 skrll rtw_watchdog(struct ifnet *ifp)
2167 1.1.2.2 skrll {
2168 1.1.2.2 skrll /* TBD */
2169 1.1.2.2 skrll return;
2170 1.1.2.2 skrll }
2171 1.1.2.2 skrll
2172 1.1.2.2 skrll static void
2173 1.1.2.2 skrll rtw_start_beacon(struct rtw_softc *sc, int enable)
2174 1.1.2.2 skrll {
2175 1.1.2.2 skrll /* TBD */
2176 1.1.2.2 skrll return;
2177 1.1.2.2 skrll }
2178 1.1.2.2 skrll
2179 1.1.2.2 skrll static void
2180 1.1.2.2 skrll rtw_next_scan(void *arg)
2181 1.1.2.2 skrll {
2182 1.1.2.2 skrll struct ieee80211com *ic = arg;
2183 1.1.2.2 skrll int s;
2184 1.1.2.2 skrll
2185 1.1.2.2 skrll /* don't call rtw_start w/o network interrupts blocked */
2186 1.1.2.2 skrll s = splnet();
2187 1.1.2.2 skrll if (ic->ic_state == IEEE80211_S_SCAN)
2188 1.1.2.2 skrll ieee80211_next_scan(ic);
2189 1.1.2.2 skrll splx(s);
2190 1.1.2.2 skrll }
2191 1.1.2.2 skrll
2192 1.1.2.2 skrll /* Synchronize the hardware state with the software state. */
2193 1.1.2.2 skrll static int
2194 1.1.2.2 skrll rtw_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
2195 1.1.2.2 skrll {
2196 1.1.2.2 skrll struct ifnet *ifp = &ic->ic_if;
2197 1.1.2.2 skrll struct rtw_softc *sc = ifp->if_softc;
2198 1.1.2.2 skrll enum ieee80211_state ostate;
2199 1.1.2.2 skrll int error;
2200 1.1.2.2 skrll
2201 1.1.2.2 skrll ostate = ic->ic_state;
2202 1.1.2.2 skrll
2203 1.1.2.2 skrll if (nstate == IEEE80211_S_INIT) {
2204 1.1.2.2 skrll callout_stop(&sc->sc_scan_ch);
2205 1.1.2.2 skrll sc->sc_cur_chan = IEEE80211_CHAN_ANY;
2206 1.1.2.2 skrll rtw_start_beacon(sc, 0);
2207 1.1.2.2 skrll return (*sc->sc_mtbl.mt_newstate)(ic, nstate, arg);
2208 1.1.2.2 skrll }
2209 1.1.2.2 skrll
2210 1.1.2.2 skrll if (ostate == IEEE80211_S_INIT && nstate != IEEE80211_S_INIT)
2211 1.1.2.2 skrll rtw_pwrstate(sc, RTW_ON);
2212 1.1.2.2 skrll
2213 1.1.2.2 skrll if ((error = rtw_tune(sc)) != 0)
2214 1.1.2.2 skrll return error;
2215 1.1.2.2 skrll
2216 1.1.2.2 skrll switch (nstate) {
2217 1.1.2.2 skrll case IEEE80211_S_ASSOC:
2218 1.1.2.2 skrll break;
2219 1.1.2.2 skrll case IEEE80211_S_INIT:
2220 1.1.2.2 skrll panic("%s: unexpected state IEEE80211_S_INIT\n", __func__);
2221 1.1.2.2 skrll break;
2222 1.1.2.2 skrll case IEEE80211_S_SCAN:
2223 1.1.2.2 skrll #if 0
2224 1.1.2.2 skrll memset(sc->sc_bssid, 0, IEEE80211_ADDR_LEN);
2225 1.1.2.2 skrll rtw_write_bssid(sc);
2226 1.1.2.2 skrll #endif
2227 1.1.2.2 skrll
2228 1.1.2.2 skrll callout_reset(&sc->sc_scan_ch, rtw_dwelltime * hz / 1000,
2229 1.1.2.2 skrll rtw_next_scan, ic);
2230 1.1.2.2 skrll
2231 1.1.2.2 skrll break;
2232 1.1.2.2 skrll case IEEE80211_S_RUN:
2233 1.1.2.2 skrll if (ic->ic_opmode == IEEE80211_M_STA)
2234 1.1.2.2 skrll break;
2235 1.1.2.2 skrll /*FALLTHROUGH*/
2236 1.1.2.2 skrll case IEEE80211_S_AUTH:
2237 1.1.2.2 skrll #if 0
2238 1.1.2.2 skrll rtw_write_bssid(sc);
2239 1.1.2.2 skrll rtw_write_bcn_thresh(sc);
2240 1.1.2.2 skrll rtw_write_ssid(sc);
2241 1.1.2.2 skrll rtw_write_sup_rates(sc);
2242 1.1.2.2 skrll #endif
2243 1.1.2.2 skrll if (ic->ic_opmode == IEEE80211_M_AHDEMO ||
2244 1.1.2.2 skrll ic->ic_opmode == IEEE80211_M_MONITOR)
2245 1.1.2.2 skrll break;
2246 1.1.2.2 skrll
2247 1.1.2.2 skrll /* TBD set listen interval, beacon interval */
2248 1.1.2.2 skrll
2249 1.1.2.2 skrll #if 0
2250 1.1.2.2 skrll rtw_tsf(sc);
2251 1.1.2.2 skrll #endif
2252 1.1.2.2 skrll break;
2253 1.1.2.2 skrll }
2254 1.1.2.2 skrll
2255 1.1.2.2 skrll if (nstate != IEEE80211_S_SCAN)
2256 1.1.2.2 skrll callout_stop(&sc->sc_scan_ch);
2257 1.1.2.2 skrll
2258 1.1.2.2 skrll if (nstate == IEEE80211_S_RUN &&
2259 1.1.2.2 skrll (ic->ic_opmode == IEEE80211_M_HOSTAP ||
2260 1.1.2.2 skrll ic->ic_opmode == IEEE80211_M_IBSS))
2261 1.1.2.2 skrll rtw_start_beacon(sc, 1);
2262 1.1.2.2 skrll else
2263 1.1.2.2 skrll rtw_start_beacon(sc, 0);
2264 1.1.2.2 skrll
2265 1.1.2.2 skrll return (*sc->sc_mtbl.mt_newstate)(ic, nstate, arg);
2266 1.1.2.2 skrll }
2267 1.1.2.2 skrll
2268 1.1.2.2 skrll static void
2269 1.1.2.2 skrll rtw_recv_beacon(struct ieee80211com *ic, struct mbuf *m0,
2270 1.1.2.2 skrll struct ieee80211_node *ni, int subtype, int rssi, u_int32_t rstamp)
2271 1.1.2.2 skrll {
2272 1.1.2.2 skrll /* TBD */
2273 1.1.2.2 skrll return;
2274 1.1.2.2 skrll }
2275 1.1.2.2 skrll
2276 1.1.2.2 skrll static void
2277 1.1.2.2 skrll rtw_recv_mgmt(struct ieee80211com *ic, struct mbuf *m,
2278 1.1.2.2 skrll struct ieee80211_node *ni, int subtype, int rssi, u_int32_t rstamp)
2279 1.1.2.2 skrll {
2280 1.1.2.2 skrll struct rtw_softc *sc = (struct rtw_softc*)ic->ic_softc;
2281 1.1.2.2 skrll
2282 1.1.2.2 skrll switch (subtype) {
2283 1.1.2.2 skrll case IEEE80211_FC0_SUBTYPE_PROBE_REQ:
2284 1.1.2.2 skrll /* do nothing: hardware answers probe request XXX */
2285 1.1.2.2 skrll break;
2286 1.1.2.2 skrll case IEEE80211_FC0_SUBTYPE_PROBE_RESP:
2287 1.1.2.2 skrll case IEEE80211_FC0_SUBTYPE_BEACON:
2288 1.1.2.2 skrll rtw_recv_beacon(ic, m, ni, subtype, rssi, rstamp);
2289 1.1.2.2 skrll break;
2290 1.1.2.2 skrll default:
2291 1.1.2.2 skrll (*sc->sc_mtbl.mt_recv_mgmt)(ic, m, ni, subtype, rssi, rstamp);
2292 1.1.2.2 skrll break;
2293 1.1.2.2 skrll }
2294 1.1.2.2 skrll return;
2295 1.1.2.2 skrll }
2296 1.1.2.2 skrll
2297 1.1.2.2 skrll static struct ieee80211_node *
2298 1.1.2.2 skrll rtw_node_alloc(struct ieee80211com *ic)
2299 1.1.2.2 skrll {
2300 1.1.2.2 skrll struct rtw_softc *sc = (struct rtw_softc *)ic->ic_if.if_softc;
2301 1.1.2.2 skrll struct ieee80211_node *ni = (*sc->sc_mtbl.mt_node_alloc)(ic);
2302 1.1.2.2 skrll
2303 1.1.2.2 skrll DPRINTF(sc, ("%s: alloc node %p\n", sc->sc_dev.dv_xname, ni));
2304 1.1.2.2 skrll return ni;
2305 1.1.2.2 skrll }
2306 1.1.2.2 skrll
2307 1.1.2.2 skrll static void
2308 1.1.2.2 skrll rtw_node_free(struct ieee80211com *ic, struct ieee80211_node *ni)
2309 1.1.2.2 skrll {
2310 1.1.2.2 skrll struct rtw_softc *sc = (struct rtw_softc *)ic->ic_if.if_softc;
2311 1.1.2.2 skrll
2312 1.1.2.2 skrll DPRINTF(sc, ("%s: freeing node %p %s\n", sc->sc_dev.dv_xname, ni,
2313 1.1.2.2 skrll ether_sprintf(ni->ni_bssid)));
2314 1.1.2.2 skrll (*sc->sc_mtbl.mt_node_free)(ic, ni);
2315 1.1.2.2 skrll }
2316 1.1.2.2 skrll
2317 1.1.2.2 skrll static int
2318 1.1.2.2 skrll rtw_media_change(struct ifnet *ifp)
2319 1.1.2.2 skrll {
2320 1.1.2.2 skrll int error;
2321 1.1.2.2 skrll
2322 1.1.2.2 skrll error = ieee80211_media_change(ifp);
2323 1.1.2.2 skrll if (error == ENETRESET) {
2324 1.1.2.2 skrll if ((ifp->if_flags & (IFF_RUNNING|IFF_UP)) ==
2325 1.1.2.2 skrll (IFF_RUNNING|IFF_UP))
2326 1.1.2.2 skrll rtw_init(ifp); /* XXX lose error */
2327 1.1.2.2 skrll error = 0;
2328 1.1.2.2 skrll }
2329 1.1.2.2 skrll return error;
2330 1.1.2.2 skrll }
2331 1.1.2.2 skrll
2332 1.1.2.2 skrll static void
2333 1.1.2.2 skrll rtw_media_status(struct ifnet *ifp, struct ifmediareq *imr)
2334 1.1.2.2 skrll {
2335 1.1.2.2 skrll struct rtw_softc *sc = ifp->if_softc;
2336 1.1.2.2 skrll
2337 1.1.2.2 skrll if ((sc->sc_flags & RTW_F_ENABLED) == 0) {
2338 1.1.2.2 skrll imr->ifm_active = IFM_IEEE80211 | IFM_NONE;
2339 1.1.2.2 skrll imr->ifm_status = 0;
2340 1.1.2.2 skrll return;
2341 1.1.2.2 skrll }
2342 1.1.2.2 skrll ieee80211_media_status(ifp, imr);
2343 1.1.2.2 skrll }
2344 1.1.2.2 skrll
2345 1.1.2.2 skrll void
2346 1.1.2.2 skrll rtw_power(int why, void *arg)
2347 1.1.2.2 skrll {
2348 1.1.2.2 skrll struct rtw_softc *sc = arg;
2349 1.1.2.2 skrll struct ifnet *ifp = &sc->sc_ic.ic_if;
2350 1.1.2.2 skrll int s;
2351 1.1.2.2 skrll
2352 1.1.2.2 skrll DPRINTF(sc, ("%s: rtw_power(%d,)\n", sc->sc_dev.dv_xname, why));
2353 1.1.2.2 skrll
2354 1.1.2.2 skrll s = splnet();
2355 1.1.2.2 skrll switch (why) {
2356 1.1.2.2 skrll case PWR_STANDBY:
2357 1.1.2.2 skrll /* XXX do nothing. */
2358 1.1.2.2 skrll break;
2359 1.1.2.2 skrll case PWR_SUSPEND:
2360 1.1.2.2 skrll rtw_stop(ifp, 0);
2361 1.1.2.2 skrll if (sc->sc_power != NULL)
2362 1.1.2.2 skrll (*sc->sc_power)(sc, why);
2363 1.1.2.2 skrll break;
2364 1.1.2.2 skrll case PWR_RESUME:
2365 1.1.2.2 skrll if (ifp->if_flags & IFF_UP) {
2366 1.1.2.2 skrll if (sc->sc_power != NULL)
2367 1.1.2.2 skrll (*sc->sc_power)(sc, why);
2368 1.1.2.2 skrll rtw_init(ifp);
2369 1.1.2.2 skrll }
2370 1.1.2.2 skrll break;
2371 1.1.2.2 skrll case PWR_SOFTSUSPEND:
2372 1.1.2.2 skrll case PWR_SOFTSTANDBY:
2373 1.1.2.2 skrll case PWR_SOFTRESUME:
2374 1.1.2.2 skrll break;
2375 1.1.2.2 skrll }
2376 1.1.2.2 skrll splx(s);
2377 1.1.2.2 skrll }
2378 1.1.2.2 skrll
2379 1.1.2.2 skrll /* rtw_shutdown: make sure the interface is stopped at reboot time. */
2380 1.1.2.2 skrll void
2381 1.1.2.2 skrll rtw_shutdown(void *arg)
2382 1.1.2.2 skrll {
2383 1.1.2.2 skrll struct rtw_softc *sc = arg;
2384 1.1.2.2 skrll
2385 1.1.2.2 skrll rtw_stop(&sc->sc_ic.ic_if, 1);
2386 1.1.2.2 skrll }
2387 1.1.2.2 skrll
2388 1.1.2.2 skrll static __inline void
2389 1.1.2.2 skrll rtw_setifprops(struct ifnet *ifp, char (*dvname)[IFNAMSIZ], void *softc)
2390 1.1.2.2 skrll {
2391 1.1.2.2 skrll (void)memcpy(ifp->if_xname, *dvname, IFNAMSIZ);
2392 1.1.2.2 skrll ifp->if_softc = softc;
2393 1.1.2.2 skrll ifp->if_flags = IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST |
2394 1.1.2.2 skrll IFF_NOTRAILERS;
2395 1.1.2.2 skrll ifp->if_ioctl = rtw_ioctl;
2396 1.1.2.2 skrll ifp->if_start = rtw_start;
2397 1.1.2.2 skrll ifp->if_watchdog = rtw_watchdog;
2398 1.1.2.2 skrll ifp->if_init = rtw_init;
2399 1.1.2.2 skrll ifp->if_stop = rtw_stop;
2400 1.1.2.2 skrll }
2401 1.1.2.2 skrll
2402 1.1.2.2 skrll static __inline void
2403 1.1.2.2 skrll rtw_set80211props(struct ieee80211com *ic)
2404 1.1.2.2 skrll {
2405 1.1.2.2 skrll int nrate;
2406 1.1.2.2 skrll ic->ic_phytype = IEEE80211_T_DS;
2407 1.1.2.2 skrll ic->ic_opmode = IEEE80211_M_STA;
2408 1.1.2.2 skrll ic->ic_caps = IEEE80211_C_PMGT | IEEE80211_C_IBSS |
2409 1.1.2.2 skrll IEEE80211_C_HOSTAP | IEEE80211_C_MONITOR | IEEE80211_C_WEP;
2410 1.1.2.2 skrll
2411 1.1.2.2 skrll nrate = 0;
2412 1.1.2.2 skrll ic->ic_sup_rates[IEEE80211_MODE_11B].rs_rates[nrate++] = 2;
2413 1.1.2.2 skrll ic->ic_sup_rates[IEEE80211_MODE_11B].rs_rates[nrate++] = 4;
2414 1.1.2.2 skrll ic->ic_sup_rates[IEEE80211_MODE_11B].rs_rates[nrate++] = 11;
2415 1.1.2.2 skrll ic->ic_sup_rates[IEEE80211_MODE_11B].rs_rates[nrate++] = 22;
2416 1.1.2.2 skrll ic->ic_sup_rates[IEEE80211_MODE_11B].rs_nrates = nrate;
2417 1.1.2.2 skrll }
2418 1.1.2.2 skrll
2419 1.1.2.2 skrll static __inline void
2420 1.1.2.2 skrll rtw_set80211methods(struct rtw_mtbl *mtbl, struct ieee80211com *ic)
2421 1.1.2.2 skrll {
2422 1.1.2.2 skrll mtbl->mt_newstate = ic->ic_newstate;
2423 1.1.2.2 skrll ic->ic_newstate = rtw_newstate;
2424 1.1.2.2 skrll
2425 1.1.2.2 skrll mtbl->mt_recv_mgmt = ic->ic_recv_mgmt;
2426 1.1.2.2 skrll ic->ic_recv_mgmt = rtw_recv_mgmt;
2427 1.1.2.2 skrll
2428 1.1.2.2 skrll mtbl->mt_node_free = ic->ic_node_free;
2429 1.1.2.2 skrll ic->ic_node_free = rtw_node_free;
2430 1.1.2.2 skrll
2431 1.1.2.2 skrll mtbl->mt_node_alloc = ic->ic_node_alloc;
2432 1.1.2.2 skrll ic->ic_node_alloc = rtw_node_alloc;
2433 1.1.2.2 skrll }
2434 1.1.2.2 skrll
2435 1.1.2.2 skrll static __inline void
2436 1.1.2.2 skrll rtw_establish_hooks(struct rtw_hooks *hooks, char (*dvname)[IFNAMSIZ],
2437 1.1.2.2 skrll void *arg)
2438 1.1.2.2 skrll {
2439 1.1.2.2 skrll /*
2440 1.1.2.2 skrll * Make sure the interface is shutdown during reboot.
2441 1.1.2.2 skrll */
2442 1.1.2.2 skrll hooks->rh_shutdown = shutdownhook_establish(rtw_shutdown, arg);
2443 1.1.2.2 skrll if (hooks->rh_shutdown == NULL)
2444 1.1.2.2 skrll printf("%s: WARNING: unable to establish shutdown hook\n",
2445 1.1.2.2 skrll *dvname);
2446 1.1.2.2 skrll
2447 1.1.2.2 skrll /*
2448 1.1.2.2 skrll * Add a suspend hook to make sure we come back up after a
2449 1.1.2.2 skrll * resume.
2450 1.1.2.2 skrll */
2451 1.1.2.2 skrll hooks->rh_power = powerhook_establish(rtw_power, arg);
2452 1.1.2.2 skrll if (hooks->rh_power == NULL)
2453 1.1.2.2 skrll printf("%s: WARNING: unable to establish power hook\n",
2454 1.1.2.2 skrll *dvname);
2455 1.1.2.2 skrll }
2456 1.1.2.2 skrll
2457 1.1.2.2 skrll static __inline void
2458 1.1.2.2 skrll rtw_disestablish_hooks(struct rtw_hooks *hooks, char (*dvname)[IFNAMSIZ],
2459 1.1.2.2 skrll void *arg)
2460 1.1.2.2 skrll {
2461 1.1.2.2 skrll if (hooks->rh_shutdown != NULL)
2462 1.1.2.2 skrll shutdownhook_disestablish(hooks->rh_shutdown);
2463 1.1.2.2 skrll
2464 1.1.2.2 skrll if (hooks->rh_power != NULL)
2465 1.1.2.2 skrll powerhook_disestablish(hooks->rh_power);
2466 1.1.2.2 skrll }
2467 1.1.2.2 skrll
2468 1.1.2.2 skrll static __inline void
2469 1.1.2.2 skrll rtw_init_radiotap(struct rtw_softc *sc)
2470 1.1.2.2 skrll {
2471 1.1.2.2 skrll memset(&sc->sc_rxtapu, 0, sizeof(sc->sc_rxtapu));
2472 1.1.2.2 skrll sc->sc_rxtap.rr_ihdr.it_len = sizeof(sc->sc_rxtapu);
2473 1.1.2.2 skrll sc->sc_rxtap.rr_ihdr.it_present = RTW_RX_RADIOTAP_PRESENT;
2474 1.1.2.2 skrll
2475 1.1.2.2 skrll memset(&sc->sc_txtapu, 0, sizeof(sc->sc_txtapu));
2476 1.1.2.2 skrll sc->sc_txtap.rt_ihdr.it_len = sizeof(sc->sc_txtapu);
2477 1.1.2.2 skrll sc->sc_txtap.rt_ihdr.it_present = RTW_TX_RADIOTAP_PRESENT;
2478 1.1.2.2 skrll }
2479 1.1.2.2 skrll
2480 1.1.2.2 skrll static int
2481 1.1.2.2 skrll rtw_txctl_blk_setup(struct rtw_txctl_blk *stc, u_int qlen)
2482 1.1.2.2 skrll {
2483 1.1.2.2 skrll SIMPLEQ_INIT(&stc->stc_dirtyq);
2484 1.1.2.2 skrll SIMPLEQ_INIT(&stc->stc_freeq);
2485 1.1.2.2 skrll stc->stc_ndesc = qlen;
2486 1.1.2.2 skrll stc->stc_desc = malloc(qlen * sizeof(*stc->stc_desc), M_DEVBUF,
2487 1.1.2.2 skrll M_NOWAIT);
2488 1.1.2.2 skrll if (stc->stc_desc == NULL)
2489 1.1.2.2 skrll return ENOMEM;
2490 1.1.2.2 skrll return 0;
2491 1.1.2.2 skrll }
2492 1.1.2.2 skrll
2493 1.1.2.2 skrll static void
2494 1.1.2.2 skrll rtw_txctl_blk_cleanup_all(struct rtw_softc *sc)
2495 1.1.2.2 skrll {
2496 1.1.2.2 skrll struct rtw_txctl_blk *stc;
2497 1.1.2.2 skrll int qlen[RTW_NTXPRI] =
2498 1.1.2.2 skrll {RTW_TXQLENLO, RTW_TXQLENMD, RTW_TXQLENHI, RTW_TXQLENBCN};
2499 1.1.2.2 skrll int pri;
2500 1.1.2.2 skrll
2501 1.1.2.2 skrll for (pri = 0; pri < sizeof(qlen)/sizeof(qlen[0]); pri++) {
2502 1.1.2.2 skrll stc = &sc->sc_txctl_blk[pri];
2503 1.1.2.2 skrll free(stc->stc_desc, M_DEVBUF);
2504 1.1.2.2 skrll stc->stc_desc = NULL;
2505 1.1.2.2 skrll }
2506 1.1.2.2 skrll }
2507 1.1.2.2 skrll
2508 1.1.2.2 skrll static int
2509 1.1.2.2 skrll rtw_txctl_blk_setup_all(struct rtw_softc *sc)
2510 1.1.2.2 skrll {
2511 1.1.2.2 skrll int pri, rc = 0;
2512 1.1.2.2 skrll int qlen[RTW_NTXPRI] =
2513 1.1.2.2 skrll {RTW_TXQLENLO, RTW_TXQLENMD, RTW_TXQLENHI, RTW_TXQLENBCN};
2514 1.1.2.2 skrll
2515 1.1.2.2 skrll for (pri = 0; pri < sizeof(qlen)/sizeof(qlen[0]); pri++) {
2516 1.1.2.2 skrll rc = rtw_txctl_blk_setup(&sc->sc_txctl_blk[pri], qlen[pri]);
2517 1.1.2.2 skrll if (rc != 0)
2518 1.1.2.2 skrll break;
2519 1.1.2.2 skrll }
2520 1.1.2.2 skrll return rc;
2521 1.1.2.2 skrll }
2522 1.1.2.2 skrll
2523 1.1.2.2 skrll static void
2524 1.1.2.2 skrll rtw_txdesc_blk_setup(struct rtw_txdesc_blk *htc, struct rtw_txdesc *desc,
2525 1.1.2.2 skrll u_int ndesc, bus_addr_t ofs, bus_addr_t physbase)
2526 1.1.2.2 skrll {
2527 1.1.2.2 skrll int i;
2528 1.1.2.2 skrll
2529 1.1.2.2 skrll htc->htc_ndesc = ndesc;
2530 1.1.2.2 skrll htc->htc_desc = desc;
2531 1.1.2.2 skrll htc->htc_physbase = physbase;
2532 1.1.2.2 skrll htc->htc_ofs = ofs;
2533 1.1.2.2 skrll
2534 1.1.2.2 skrll (void)memset(htc->htc_desc, 0,
2535 1.1.2.2 skrll sizeof(htc->htc_desc[0]) * htc->htc_ndesc);
2536 1.1.2.2 skrll
2537 1.1.2.2 skrll for (i = 0; i < htc->htc_ndesc; i++) {
2538 1.1.2.2 skrll htc->htc_desc[i].htx_next = htole32(RTW_NEXT_DESC(htc, i));
2539 1.1.2.2 skrll }
2540 1.1.2.2 skrll }
2541 1.1.2.2 skrll
2542 1.1.2.2 skrll static void
2543 1.1.2.2 skrll rtw_txdesc_blk_setup_all(struct rtw_softc *sc)
2544 1.1.2.2 skrll {
2545 1.1.2.2 skrll rtw_txdesc_blk_setup(&sc->sc_txdesc_blk[RTW_TXPRILO],
2546 1.1.2.2 skrll &sc->sc_descs->hd_txlo[0], RTW_NTXDESCLO,
2547 1.1.2.2 skrll RTW_RING_OFFSET(hd_txlo), RTW_RING_BASE(sc, hd_txlo));
2548 1.1.2.2 skrll
2549 1.1.2.2 skrll rtw_txdesc_blk_setup(&sc->sc_txdesc_blk[RTW_TXPRIMD],
2550 1.1.2.2 skrll &sc->sc_descs->hd_txmd[0], RTW_NTXDESCMD,
2551 1.1.2.2 skrll RTW_RING_OFFSET(hd_txmd), RTW_RING_BASE(sc, hd_txmd));
2552 1.1.2.2 skrll
2553 1.1.2.2 skrll rtw_txdesc_blk_setup(&sc->sc_txdesc_blk[RTW_TXPRIHI],
2554 1.1.2.2 skrll &sc->sc_descs->hd_txhi[0], RTW_NTXDESCHI,
2555 1.1.2.2 skrll RTW_RING_OFFSET(hd_txhi), RTW_RING_BASE(sc, hd_txhi));
2556 1.1.2.2 skrll
2557 1.1.2.2 skrll rtw_txdesc_blk_setup(&sc->sc_txdesc_blk[RTW_TXPRIBCN],
2558 1.1.2.2 skrll &sc->sc_descs->hd_bcn[0], RTW_NTXDESCBCN,
2559 1.1.2.2 skrll RTW_RING_OFFSET(hd_bcn), RTW_RING_BASE(sc, hd_bcn));
2560 1.1.2.2 skrll }
2561 1.1.2.2 skrll
2562 1.1.2.2 skrll static struct rtw_rf *
2563 1.1.2.2 skrll rtw_rf_attach(struct rtw_softc *sc, enum rtw_rfchipid rfchipid,
2564 1.1.2.2 skrll rtw_rf_write_t rf_write, int digphy)
2565 1.1.2.2 skrll {
2566 1.1.2.2 skrll struct rtw_rf *rf;
2567 1.1.2.2 skrll
2568 1.1.2.2 skrll switch (rfchipid) {
2569 1.1.2.2 skrll case RTW_RFCHIPID_MAXIM:
2570 1.1.2.2 skrll rf = rtw_max2820_create(&sc->sc_regs, rf_write, 0);
2571 1.1.2.2 skrll sc->sc_pwrstate_cb = rtw_maxim_pwrstate;
2572 1.1.2.2 skrll break;
2573 1.1.2.2 skrll case RTW_RFCHIPID_PHILIPS:
2574 1.1.2.2 skrll rf = rtw_sa2400_create(&sc->sc_regs, rf_write, digphy);
2575 1.1.2.2 skrll sc->sc_pwrstate_cb = rtw_philips_pwrstate;
2576 1.1.2.2 skrll break;
2577 1.1.2.2 skrll default:
2578 1.1.2.2 skrll return NULL;
2579 1.1.2.2 skrll }
2580 1.1.2.2 skrll rf->rf_continuous_tx_cb =
2581 1.1.2.2 skrll (rtw_continuous_tx_cb_t)rtw_continuous_tx_enable;
2582 1.1.2.2 skrll rf->rf_continuous_tx_arg = (void *)sc;
2583 1.1.2.2 skrll return rf;
2584 1.1.2.2 skrll }
2585 1.1.2.2 skrll
2586 1.1.2.2 skrll /* Revision C and later use a different PHY delay setting than
2587 1.1.2.2 skrll * revisions A and B.
2588 1.1.2.2 skrll */
2589 1.1.2.2 skrll static u_int8_t
2590 1.1.2.2 skrll rtw_check_phydelay(struct rtw_regs *regs, u_int32_t rcr0)
2591 1.1.2.2 skrll {
2592 1.1.2.2 skrll #define REVAB (RTW_RCR_MXDMA_UNLIMITED | RTW_RCR_AICV)
2593 1.1.2.2 skrll #define REVC (REVAB | RTW_RCR_RXFTH_WHOLE)
2594 1.1.2.2 skrll
2595 1.1.2.2 skrll u_int8_t phydelay = LSHIFT(0x6, RTW_PHYDELAY_PHYDELAY);
2596 1.1.2.2 skrll
2597 1.1.2.2 skrll RTW_WRITE(regs, RTW_RCR, REVAB);
2598 1.1.2.2 skrll RTW_WRITE(regs, RTW_RCR, REVC);
2599 1.1.2.2 skrll
2600 1.1.2.2 skrll RTW_WBR(regs, RTW_RCR, RTW_RCR);
2601 1.1.2.2 skrll if ((RTW_READ(regs, RTW_RCR) & REVC) == REVC)
2602 1.1.2.2 skrll phydelay |= RTW_PHYDELAY_REVC_MAGIC;
2603 1.1.2.2 skrll
2604 1.1.2.2 skrll RTW_WRITE(regs, RTW_RCR, rcr0); /* restore RCR */
2605 1.1.2.2 skrll
2606 1.1.2.2 skrll return phydelay;
2607 1.1.2.2 skrll #undef REVC
2608 1.1.2.2 skrll }
2609 1.1.2.2 skrll
2610 1.1.2.2 skrll void
2611 1.1.2.2 skrll rtw_attach(struct rtw_softc *sc)
2612 1.1.2.2 skrll {
2613 1.1.2.2 skrll rtw_rf_write_t rf_write;
2614 1.1.2.2 skrll struct rtw_txctl_blk *stc;
2615 1.1.2.2 skrll int pri, rc, vers;
2616 1.1.2.2 skrll
2617 1.1.2.2 skrll #if 0
2618 1.1.2.2 skrll CASSERT(RTW_DESC_ALIGNMENT % sizeof(struct rtw_txdesc) == 0,
2619 1.1.2.2 skrll "RTW_DESC_ALIGNMENT is not a multiple of "
2620 1.1.2.2 skrll "sizeof(struct rtw_txdesc)");
2621 1.1.2.2 skrll
2622 1.1.2.2 skrll CASSERT(RTW_DESC_ALIGNMENT % sizeof(struct rtw_rxdesc) == 0,
2623 1.1.2.2 skrll "RTW_DESC_ALIGNMENT is not a multiple of "
2624 1.1.2.2 skrll "sizeof(struct rtw_rxdesc)");
2625 1.1.2.2 skrll
2626 1.1.2.2 skrll CASSERT(RTW_DESC_ALIGNMENT % RTW_MAXPKTSEGS == 0,
2627 1.1.2.2 skrll "RTW_DESC_ALIGNMENT is not a multiple of RTW_MAXPKTSEGS");
2628 1.1.2.2 skrll #endif
2629 1.1.2.2 skrll
2630 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, DETACHED);
2631 1.1.2.2 skrll
2632 1.1.2.2 skrll switch (RTW_READ(&sc->sc_regs, RTW_TCR) & RTW_TCR_HWVERID_MASK) {
2633 1.1.2.2 skrll case RTW_TCR_HWVERID_F:
2634 1.1.2.2 skrll vers = 'F';
2635 1.1.2.2 skrll rf_write = rtw_rf_hostwrite;
2636 1.1.2.2 skrll break;
2637 1.1.2.2 skrll case RTW_TCR_HWVERID_D:
2638 1.1.2.2 skrll vers = 'D';
2639 1.1.2.4 skrll if (rtw_host_rfio)
2640 1.1.2.4 skrll rf_write = rtw_rf_hostwrite;
2641 1.1.2.4 skrll else
2642 1.1.2.4 skrll rf_write = rtw_rf_macwrite;
2643 1.1.2.2 skrll break;
2644 1.1.2.2 skrll default:
2645 1.1.2.2 skrll vers = '?';
2646 1.1.2.2 skrll rf_write = rtw_rf_macwrite;
2647 1.1.2.2 skrll break;
2648 1.1.2.2 skrll }
2649 1.1.2.2 skrll printf("%s: hardware version %c\n", sc->sc_dev.dv_xname, vers);
2650 1.1.2.2 skrll
2651 1.1.2.2 skrll rc = bus_dmamem_alloc(sc->sc_dmat, sizeof(struct rtw_descs),
2652 1.1.2.2 skrll RTW_DESC_ALIGNMENT, 0, &sc->sc_desc_segs, 1, &sc->sc_desc_nsegs,
2653 1.1.2.2 skrll 0);
2654 1.1.2.2 skrll
2655 1.1.2.2 skrll if (rc != 0) {
2656 1.1.2.2 skrll printf("%s: could not allocate hw descriptors, error %d\n",
2657 1.1.2.2 skrll sc->sc_dev.dv_xname, rc);
2658 1.1.2.2 skrll goto err;
2659 1.1.2.2 skrll }
2660 1.1.2.2 skrll
2661 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_DESC_ALLOC);
2662 1.1.2.2 skrll
2663 1.1.2.2 skrll rc = bus_dmamem_map(sc->sc_dmat, &sc->sc_desc_segs,
2664 1.1.2.2 skrll sc->sc_desc_nsegs, sizeof(struct rtw_descs),
2665 1.1.2.2 skrll (caddr_t*)&sc->sc_descs, BUS_DMA_COHERENT);
2666 1.1.2.2 skrll
2667 1.1.2.2 skrll if (rc != 0) {
2668 1.1.2.2 skrll printf("%s: could not map hw descriptors, error %d\n",
2669 1.1.2.2 skrll sc->sc_dev.dv_xname, rc);
2670 1.1.2.2 skrll goto err;
2671 1.1.2.2 skrll }
2672 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_DESC_MAP);
2673 1.1.2.2 skrll
2674 1.1.2.2 skrll rc = bus_dmamap_create(sc->sc_dmat, sizeof(struct rtw_descs), 1,
2675 1.1.2.2 skrll sizeof(struct rtw_descs), 0, 0, &sc->sc_desc_dmamap);
2676 1.1.2.2 skrll
2677 1.1.2.2 skrll if (rc != 0) {
2678 1.1.2.2 skrll printf("%s: could not create DMA map for hw descriptors, "
2679 1.1.2.2 skrll "error %d\n", sc->sc_dev.dv_xname, rc);
2680 1.1.2.2 skrll goto err;
2681 1.1.2.2 skrll }
2682 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_DESCMAP_CREATE);
2683 1.1.2.2 skrll
2684 1.1.2.2 skrll rc = bus_dmamap_load(sc->sc_dmat, sc->sc_desc_dmamap, sc->sc_descs,
2685 1.1.2.2 skrll sizeof(struct rtw_descs), NULL, 0);
2686 1.1.2.2 skrll
2687 1.1.2.2 skrll if (rc != 0) {
2688 1.1.2.2 skrll printf("%s: could not load DMA map for hw descriptors, "
2689 1.1.2.2 skrll "error %d\n", sc->sc_dev.dv_xname, rc);
2690 1.1.2.2 skrll goto err;
2691 1.1.2.2 skrll }
2692 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_DESCMAP_LOAD);
2693 1.1.2.2 skrll
2694 1.1.2.2 skrll if (rtw_txctl_blk_setup_all(sc) != 0)
2695 1.1.2.2 skrll goto err;
2696 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_TXCTLBLK_SETUP);
2697 1.1.2.2 skrll
2698 1.1.2.2 skrll rtw_txdesc_blk_setup_all(sc);
2699 1.1.2.2 skrll
2700 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_TXDESCBLK_SETUP);
2701 1.1.2.2 skrll
2702 1.1.2.2 skrll sc->sc_rxdesc = &sc->sc_descs->hd_rx[0];
2703 1.1.2.2 skrll
2704 1.1.2.4 skrll rtw_rxctls_setup(&sc->sc_rxctl[0]);
2705 1.1.2.2 skrll
2706 1.1.2.2 skrll for (pri = 0; pri < RTW_NTXPRI; pri++) {
2707 1.1.2.2 skrll stc = &sc->sc_txctl_blk[pri];
2708 1.1.2.2 skrll
2709 1.1.2.2 skrll if ((rc = rtw_txdesc_dmamaps_create(sc->sc_dmat,
2710 1.1.2.2 skrll &stc->stc_desc[0], stc->stc_ndesc)) != 0) {
2711 1.1.2.2 skrll printf("%s: could not load DMA map for "
2712 1.1.2.2 skrll "hw tx descriptors, error %d\n",
2713 1.1.2.2 skrll sc->sc_dev.dv_xname, rc);
2714 1.1.2.2 skrll goto err;
2715 1.1.2.2 skrll }
2716 1.1.2.2 skrll }
2717 1.1.2.2 skrll
2718 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_TXMAPS_CREATE);
2719 1.1.2.2 skrll if ((rc = rtw_rxdesc_dmamaps_create(sc->sc_dmat, &sc->sc_rxctl[0],
2720 1.1.2.2 skrll RTW_RXQLEN)) != 0) {
2721 1.1.2.2 skrll printf("%s: could not load DMA map for hw rx descriptors, "
2722 1.1.2.2 skrll "error %d\n", sc->sc_dev.dv_xname, rc);
2723 1.1.2.2 skrll goto err;
2724 1.1.2.2 skrll }
2725 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_RXMAPS_CREATE);
2726 1.1.2.2 skrll
2727 1.1.2.2 skrll /* Reset the chip to a known state. */
2728 1.1.2.2 skrll if (rtw_reset(sc) != 0)
2729 1.1.2.2 skrll goto err;
2730 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_RESET);
2731 1.1.2.2 skrll
2732 1.1.2.2 skrll sc->sc_rcr = RTW_READ(&sc->sc_regs, RTW_RCR);
2733 1.1.2.2 skrll
2734 1.1.2.2 skrll if ((sc->sc_rcr & RTW_RCR_9356SEL) != 0)
2735 1.1.2.2 skrll sc->sc_flags |= RTW_F_9356SROM;
2736 1.1.2.2 skrll
2737 1.1.2.2 skrll if (rtw_srom_read(&sc->sc_regs, sc->sc_flags, &sc->sc_srom,
2738 1.1.2.2 skrll &sc->sc_dev.dv_xname) != 0)
2739 1.1.2.2 skrll goto err;
2740 1.1.2.2 skrll
2741 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_READ_SROM);
2742 1.1.2.2 skrll
2743 1.1.2.2 skrll if (rtw_srom_parse(&sc->sc_srom, &sc->sc_flags, &sc->sc_csthr,
2744 1.1.2.2 skrll &sc->sc_rfchipid, &sc->sc_rcr, &sc->sc_locale,
2745 1.1.2.2 skrll &sc->sc_dev.dv_xname) != 0) {
2746 1.1.2.2 skrll printf("%s: attach failed, malformed serial ROM\n",
2747 1.1.2.2 skrll sc->sc_dev.dv_xname);
2748 1.1.2.2 skrll goto err;
2749 1.1.2.2 skrll }
2750 1.1.2.2 skrll
2751 1.1.2.2 skrll RTW_DPRINTF(("%s: CS threshold %u\n", sc->sc_dev.dv_xname,
2752 1.1.2.2 skrll sc->sc_csthr));
2753 1.1.2.2 skrll
2754 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_PARSE_SROM);
2755 1.1.2.2 skrll
2756 1.1.2.2 skrll sc->sc_rf = rtw_rf_attach(sc, sc->sc_rfchipid, rf_write,
2757 1.1.2.2 skrll sc->sc_flags & RTW_F_DIGPHY);
2758 1.1.2.2 skrll
2759 1.1.2.2 skrll if (sc->sc_rf == NULL) {
2760 1.1.2.2 skrll printf("%s: attach failed, could not attach RF\n",
2761 1.1.2.2 skrll sc->sc_dev.dv_xname);
2762 1.1.2.2 skrll goto err;
2763 1.1.2.2 skrll }
2764 1.1.2.2 skrll
2765 1.1.2.2 skrll #if 0
2766 1.1.2.2 skrll if (rtw_identify_rf(&sc->sc_regs, &sc->sc_rftype,
2767 1.1.2.2 skrll &sc->sc_dev.dv_xname) != 0) {
2768 1.1.2.2 skrll printf("%s: attach failed, unknown RF unidentified\n",
2769 1.1.2.2 skrll sc->sc_dev.dv_xname);
2770 1.1.2.2 skrll goto err;
2771 1.1.2.2 skrll }
2772 1.1.2.2 skrll #endif
2773 1.1.2.2 skrll
2774 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_RF_ATTACH);
2775 1.1.2.2 skrll
2776 1.1.2.2 skrll sc->sc_phydelay = rtw_check_phydelay(&sc->sc_regs, sc->sc_rcr);
2777 1.1.2.2 skrll
2778 1.1.2.2 skrll RTW_DPRINTF(("%s: PHY delay %d\n", sc->sc_dev.dv_xname,
2779 1.1.2.2 skrll sc->sc_phydelay));
2780 1.1.2.2 skrll
2781 1.1.2.2 skrll if (sc->sc_locale == RTW_LOCALE_UNKNOWN)
2782 1.1.2.2 skrll rtw_identify_country(&sc->sc_regs, &sc->sc_locale,
2783 1.1.2.2 skrll &sc->sc_dev.dv_xname);
2784 1.1.2.2 skrll
2785 1.1.2.2 skrll rtw_init_channels(sc->sc_locale, &sc->sc_ic.ic_channels,
2786 1.1.2.2 skrll &sc->sc_dev.dv_xname);
2787 1.1.2.2 skrll
2788 1.1.2.2 skrll if (rtw_identify_sta(&sc->sc_regs, &sc->sc_ic.ic_myaddr,
2789 1.1.2.2 skrll &sc->sc_dev.dv_xname) != 0)
2790 1.1.2.2 skrll goto err;
2791 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISH_ID_STA);
2792 1.1.2.2 skrll
2793 1.1.2.2 skrll rtw_setifprops(&sc->sc_if, &sc->sc_dev.dv_xname, (void*)sc);
2794 1.1.2.2 skrll
2795 1.1.2.2 skrll IFQ_SET_READY(&sc->sc_if.if_snd);
2796 1.1.2.2 skrll
2797 1.1.2.2 skrll rtw_set80211props(&sc->sc_ic);
2798 1.1.2.2 skrll
2799 1.1.2.2 skrll /*
2800 1.1.2.2 skrll * Call MI attach routines.
2801 1.1.2.2 skrll */
2802 1.1.2.2 skrll if_attach(&sc->sc_if);
2803 1.1.2.2 skrll ieee80211_ifattach(&sc->sc_if);
2804 1.1.2.2 skrll
2805 1.1.2.2 skrll rtw_set80211methods(&sc->sc_mtbl, &sc->sc_ic);
2806 1.1.2.2 skrll
2807 1.1.2.2 skrll /* possibly we should fill in our own sc_send_prresp, since
2808 1.1.2.2 skrll * the RTL8180 is probably sending probe responses in ad hoc
2809 1.1.2.2 skrll * mode.
2810 1.1.2.2 skrll */
2811 1.1.2.2 skrll
2812 1.1.2.2 skrll /* complete initialization */
2813 1.1.2.2 skrll ieee80211_media_init(&sc->sc_if, rtw_media_change, rtw_media_status);
2814 1.1.2.2 skrll callout_init(&sc->sc_scan_ch);
2815 1.1.2.2 skrll
2816 1.1.2.2 skrll #if NBPFILTER > 0
2817 1.1.2.2 skrll bpfattach2(&sc->sc_if, DLT_IEEE802_11_RADIO,
2818 1.1.2.2 skrll sizeof(struct ieee80211_frame) + 64, &sc->sc_radiobpf);
2819 1.1.2.2 skrll #endif
2820 1.1.2.2 skrll
2821 1.1.2.2 skrll rtw_establish_hooks(&sc->sc_hooks, &sc->sc_dev.dv_xname, (void*)sc);
2822 1.1.2.2 skrll
2823 1.1.2.2 skrll rtw_init_radiotap(sc);
2824 1.1.2.2 skrll
2825 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, FINISHED);
2826 1.1.2.2 skrll
2827 1.1.2.2 skrll return;
2828 1.1.2.2 skrll err:
2829 1.1.2.2 skrll rtw_detach(sc);
2830 1.1.2.2 skrll return;
2831 1.1.2.2 skrll }
2832 1.1.2.2 skrll
2833 1.1.2.2 skrll int
2834 1.1.2.2 skrll rtw_detach(struct rtw_softc *sc)
2835 1.1.2.2 skrll {
2836 1.1.2.2 skrll int pri;
2837 1.1.2.2 skrll
2838 1.1.2.2 skrll switch (sc->sc_attach_state) {
2839 1.1.2.2 skrll case FINISHED:
2840 1.1.2.4 skrll rtw_stop(&sc->sc_if, 1);
2841 1.1.2.4 skrll
2842 1.1.2.2 skrll rtw_disestablish_hooks(&sc->sc_hooks, &sc->sc_dev.dv_xname,
2843 1.1.2.2 skrll (void*)sc);
2844 1.1.2.2 skrll callout_stop(&sc->sc_scan_ch);
2845 1.1.2.2 skrll ieee80211_ifdetach(&sc->sc_if);
2846 1.1.2.2 skrll if_detach(&sc->sc_if);
2847 1.1.2.2 skrll break;
2848 1.1.2.2 skrll case FINISH_ID_STA:
2849 1.1.2.2 skrll case FINISH_RF_ATTACH:
2850 1.1.2.2 skrll rtw_rf_destroy(sc->sc_rf);
2851 1.1.2.2 skrll sc->sc_rf = NULL;
2852 1.1.2.2 skrll /*FALLTHROUGH*/
2853 1.1.2.2 skrll case FINISH_PARSE_SROM:
2854 1.1.2.2 skrll case FINISH_READ_SROM:
2855 1.1.2.2 skrll rtw_srom_free(&sc->sc_srom);
2856 1.1.2.2 skrll /*FALLTHROUGH*/
2857 1.1.2.2 skrll case FINISH_RESET:
2858 1.1.2.2 skrll case FINISH_RXMAPS_CREATE:
2859 1.1.2.2 skrll rtw_rxdesc_dmamaps_destroy(sc->sc_dmat, &sc->sc_rxctl[0],
2860 1.1.2.2 skrll RTW_RXQLEN);
2861 1.1.2.2 skrll /*FALLTHROUGH*/
2862 1.1.2.2 skrll case FINISH_TXMAPS_CREATE:
2863 1.1.2.2 skrll for (pri = 0; pri < RTW_NTXPRI; pri++) {
2864 1.1.2.2 skrll rtw_txdesc_dmamaps_destroy(sc->sc_dmat,
2865 1.1.2.2 skrll sc->sc_txctl_blk[pri].stc_desc,
2866 1.1.2.2 skrll sc->sc_txctl_blk[pri].stc_ndesc);
2867 1.1.2.2 skrll }
2868 1.1.2.2 skrll /*FALLTHROUGH*/
2869 1.1.2.2 skrll case FINISH_TXDESCBLK_SETUP:
2870 1.1.2.2 skrll case FINISH_TXCTLBLK_SETUP:
2871 1.1.2.2 skrll rtw_txctl_blk_cleanup_all(sc);
2872 1.1.2.2 skrll /*FALLTHROUGH*/
2873 1.1.2.2 skrll case FINISH_DESCMAP_LOAD:
2874 1.1.2.2 skrll bus_dmamap_unload(sc->sc_dmat, sc->sc_desc_dmamap);
2875 1.1.2.2 skrll /*FALLTHROUGH*/
2876 1.1.2.2 skrll case FINISH_DESCMAP_CREATE:
2877 1.1.2.2 skrll bus_dmamap_destroy(sc->sc_dmat, sc->sc_desc_dmamap);
2878 1.1.2.2 skrll /*FALLTHROUGH*/
2879 1.1.2.2 skrll case FINISH_DESC_MAP:
2880 1.1.2.2 skrll bus_dmamem_unmap(sc->sc_dmat, (caddr_t)sc->sc_descs,
2881 1.1.2.2 skrll sizeof(struct rtw_descs));
2882 1.1.2.2 skrll /*FALLTHROUGH*/
2883 1.1.2.2 skrll case FINISH_DESC_ALLOC:
2884 1.1.2.2 skrll bus_dmamem_free(sc->sc_dmat, &sc->sc_desc_segs,
2885 1.1.2.2 skrll sc->sc_desc_nsegs);
2886 1.1.2.2 skrll /*FALLTHROUGH*/
2887 1.1.2.2 skrll case DETACHED:
2888 1.1.2.2 skrll NEXT_ATTACH_STATE(sc, DETACHED);
2889 1.1.2.2 skrll break;
2890 1.1.2.2 skrll }
2891 1.1.2.2 skrll return 0;
2892 1.1.2.2 skrll }
2893 1.1.2.2 skrll
2894 1.1.2.2 skrll int
2895 1.1.2.2 skrll rtw_activate(struct device *self, enum devact act)
2896 1.1.2.2 skrll {
2897 1.1.2.2 skrll struct rtw_softc *sc = (struct rtw_softc *)self;
2898 1.1.2.2 skrll int rc = 0, s;
2899 1.1.2.2 skrll
2900 1.1.2.2 skrll s = splnet();
2901 1.1.2.2 skrll switch (act) {
2902 1.1.2.2 skrll case DVACT_ACTIVATE:
2903 1.1.2.2 skrll rc = EOPNOTSUPP;
2904 1.1.2.2 skrll break;
2905 1.1.2.2 skrll
2906 1.1.2.2 skrll case DVACT_DEACTIVATE:
2907 1.1.2.2 skrll if_deactivate(&sc->sc_ic.ic_if);
2908 1.1.2.2 skrll break;
2909 1.1.2.2 skrll }
2910 1.1.2.2 skrll splx(s);
2911 1.1.2.2 skrll return rc;
2912 1.1.2.2 skrll }
2913