Annotation of sys/dev/ic/if_wi.c, Revision 1.1.1.1
1.1 nbrk 1: /* $OpenBSD: if_wi.c,v 1.137 2006/11/26 19:46:28 deraadt Exp $ */
2:
3: /*
4: * Copyright (c) 1997, 1998, 1999
5: * Bill Paul <wpaul@ctr.columbia.edu>. All rights reserved.
6: *
7: * Redistribution and use in source and binary forms, with or without
8: * modification, are permitted provided that the following conditions
9: * are met:
10: * 1. Redistributions of source code must retain the above copyright
11: * notice, this list of conditions and the following disclaimer.
12: * 2. Redistributions in binary form must reproduce the above copyright
13: * notice, this list of conditions and the following disclaimer in the
14: * documentation and/or other materials provided with the distribution.
15: * 3. All advertising materials mentioning features or use of this software
16: * must display the following acknowledgement:
17: * This product includes software developed by Bill Paul.
18: * 4. Neither the name of the author nor the names of any co-contributors
19: * may be used to endorse or promote products derived from this software
20: * without specific prior written permission.
21: *
22: * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
23: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25: * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
26: * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
27: * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
28: * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
29: * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
30: * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
31: * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
32: * THE POSSIBILITY OF SUCH DAMAGE.
33: *
34: * From: if_wi.c,v 1.7 1999/07/04 14:40:22 wpaul Exp $
35: */
36:
37: /*
38: * Lucent WaveLAN/IEEE 802.11 driver for OpenBSD.
39: *
40: * Originally written by Bill Paul <wpaul@ctr.columbia.edu>
41: * Electrical Engineering Department
42: * Columbia University, New York City
43: */
44:
45: /*
46: * The WaveLAN/IEEE adapter is the second generation of the WaveLAN
47: * from Lucent. Unlike the older cards, the new ones are programmed
48: * entirely via a firmware-driven controller called the Hermes.
49: * Unfortunately, Lucent will not release the Hermes programming manual
50: * without an NDA (if at all). What they do release is an API library
51: * called the HCF (Hardware Control Functions) which is supposed to
52: * do the device-specific operations of a device driver for you. The
53: * publicly available version of the HCF library (the 'HCF Light') is
54: * a) extremely gross, b) lacks certain features, particularly support
55: * for 802.11 frames, and c) is contaminated by the GNU Public License.
56: *
57: * This driver does not use the HCF or HCF Light at all. Instead, it
58: * programs the Hermes controller directly, using information gleaned
59: * from the HCF Light code and corresponding documentation.
60: */
61:
62: #define WI_HERMES_AUTOINC_WAR /* Work around data write autoinc bug. */
63: #define WI_HERMES_STATS_WAR /* Work around stats counter bug. */
64:
65: #include "bpfilter.h"
66:
67: #include <sys/param.h>
68: #include <sys/systm.h>
69: #include <sys/sockio.h>
70: #include <sys/mbuf.h>
71: #include <sys/malloc.h>
72: #include <sys/kernel.h>
73: #include <sys/proc.h>
74: #include <sys/socket.h>
75: #include <sys/device.h>
76:
77: #include <net/if.h>
78: #include <net/if_dl.h>
79: #include <net/if_media.h>
80: #include <net/if_types.h>
81:
82: #ifdef INET
83: #include <netinet/in.h>
84: #include <netinet/in_systm.h>
85: #include <netinet/in_var.h>
86: #include <netinet/ip.h>
87: #include <netinet/if_ether.h>
88: #endif
89:
90: #include <net80211/ieee80211_var.h>
91: #include <net80211/ieee80211_ioctl.h>
92:
93: #if NBPFILTER > 0
94: #include <net/bpf.h>
95: #endif
96:
97: #include <machine/bus.h>
98:
99: #include <dev/rndvar.h>
100:
101: #include <dev/ic/if_wireg.h>
102: #include <dev/ic/if_wi_ieee.h>
103: #include <dev/ic/if_wivar.h>
104:
105: #include <crypto/arc4.h>
106:
107: #define BPFATTACH(if_bpf,if,dlt,sz)
108: #define STATIC
109:
110: #ifdef WIDEBUG
111:
112: u_int32_t widebug = WIDEBUG;
113:
114: #define WID_INTR 0x01
115: #define WID_START 0x02
116: #define WID_IOCTL 0x04
117: #define WID_INIT 0x08
118: #define WID_STOP 0x10
119: #define WID_RESET 0x20
120:
121: #define DPRINTF(mask,args) if (widebug & (mask)) printf args;
122:
123: #else /* !WIDEBUG */
124: #define DPRINTF(mask,args)
125: #endif /* WIDEBUG */
126:
127: #if !defined(lint) && !defined(__OpenBSD__)
128: static const char rcsid[] =
129: "$OpenBSD: if_wi.c,v 1.137 2006/11/26 19:46:28 deraadt Exp $";
130: #endif /* lint */
131:
132: #ifdef foo
133: static u_int8_t wi_mcast_addr[6] = { 0x01, 0x60, 0x1D, 0x00, 0x01, 0x00 };
134: #endif
135:
136: STATIC void wi_reset(struct wi_softc *);
137: STATIC int wi_ioctl(struct ifnet *, u_long, caddr_t);
138: STATIC void wi_init_io(struct wi_softc *);
139: STATIC void wi_start(struct ifnet *);
140: STATIC void wi_watchdog(struct ifnet *);
141: STATIC void wi_shutdown(void *);
142: STATIC void wi_rxeof(struct wi_softc *);
143: STATIC void wi_txeof(struct wi_softc *, int);
144: STATIC void wi_update_stats(struct wi_softc *);
145: STATIC void wi_setmulti(struct wi_softc *);
146:
147: STATIC int wi_cmd_io(struct wi_softc *, int, int, int, int);
148: STATIC int wi_read_record_io(struct wi_softc *, struct wi_ltv_gen *);
149: STATIC int wi_write_record_io(struct wi_softc *, struct wi_ltv_gen *);
150: STATIC int wi_read_data_io(struct wi_softc *, int,
151: int, caddr_t, int);
152: STATIC int wi_write_data_io(struct wi_softc *, int,
153: int, caddr_t, int);
154: STATIC int wi_seek(struct wi_softc *, int, int, int);
155:
156: STATIC void wi_inquire(void *);
157: STATIC int wi_setdef(struct wi_softc *, struct wi_req *);
158: STATIC void wi_get_id(struct wi_softc *);
159:
160: STATIC int wi_media_change(struct ifnet *);
161: STATIC void wi_media_status(struct ifnet *, struct ifmediareq *);
162:
163: STATIC int wi_set_ssid(struct ieee80211_nwid *, u_int8_t *, int);
164: STATIC int wi_set_nwkey(struct wi_softc *, struct ieee80211_nwkey *);
165: STATIC int wi_get_nwkey(struct wi_softc *, struct ieee80211_nwkey *);
166: STATIC int wi_sync_media(struct wi_softc *, int, int);
167: STATIC int wi_set_pm(struct wi_softc *, struct ieee80211_power *);
168: STATIC int wi_get_pm(struct wi_softc *, struct ieee80211_power *);
169: STATIC int wi_set_txpower(struct wi_softc *, struct ieee80211_txpower *);
170: STATIC int wi_get_txpower(struct wi_softc *, struct ieee80211_txpower *);
171:
172: STATIC int wi_get_debug(struct wi_softc *, struct wi_req *);
173: STATIC int wi_set_debug(struct wi_softc *, struct wi_req *);
174:
175: STATIC void wi_do_hostencrypt(struct wi_softc *, caddr_t, int);
176: STATIC int wi_do_hostdecrypt(struct wi_softc *, caddr_t, int);
177:
178: STATIC int wi_alloc_nicmem_io(struct wi_softc *, int, int *);
179: STATIC int wi_get_fid_io(struct wi_softc *sc, int fid);
180: STATIC void wi_intr_enable(struct wi_softc *sc, int mode);
181: STATIC void wi_intr_ack(struct wi_softc *sc, int mode);
182: void wi_scan_timeout(void *);
183:
184: /* Autoconfig definition of driver back-end */
185: struct cfdriver wi_cd = {
186: NULL, "wi", DV_IFNET
187: };
188:
189: const struct wi_card_ident wi_card_ident[] = {
190: WI_CARD_IDS
191: };
192:
193: struct wi_funcs wi_func_io = {
194: wi_cmd_io,
195: wi_read_record_io,
196: wi_write_record_io,
197: wi_alloc_nicmem_io,
198: wi_read_data_io,
199: wi_write_data_io,
200: wi_get_fid_io,
201: wi_init_io,
202:
203: wi_start,
204: wi_ioctl,
205: wi_watchdog,
206: wi_inquire,
207: };
208:
209: int
210: wi_attach(struct wi_softc *sc, struct wi_funcs *funcs)
211: {
212: struct ieee80211com *ic;
213: struct ifnet *ifp;
214: struct wi_ltv_macaddr mac;
215: struct wi_ltv_rates rates;
216: struct wi_ltv_gen gen;
217: int error;
218:
219: ic = &sc->sc_ic;
220: ifp = &ic->ic_if;
221:
222: sc->sc_funcs = funcs;
223: sc->wi_cmd_count = 500;
224:
225: wi_reset(sc);
226:
227: /* Read the station address. */
228: mac.wi_type = WI_RID_MAC_NODE;
229: mac.wi_len = 4;
230: error = wi_read_record(sc, (struct wi_ltv_gen *)&mac);
231: if (error) {
232: printf(": unable to read station address\n");
233: return (error);
234: }
235: bcopy((char *)&mac.wi_mac_addr, (char *)&ic->ic_myaddr,
236: IEEE80211_ADDR_LEN);
237:
238: wi_get_id(sc);
239: printf("address %s", ether_sprintf(ic->ic_myaddr));
240:
241: bcopy(sc->sc_dev.dv_xname, ifp->if_xname, IFNAMSIZ);
242: ifp->if_softc = sc;
243: ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
244: ifp->if_ioctl = funcs->f_ioctl;
245: ifp->if_start = funcs->f_start;
246: ifp->if_watchdog = funcs->f_watchdog;
247: ifp->if_baudrate = 10000000;
248: IFQ_SET_READY(&ifp->if_snd);
249:
250: (void)wi_set_ssid(&sc->wi_node_name, WI_DEFAULT_NODENAME,
251: sizeof(WI_DEFAULT_NODENAME) - 1);
252: (void)wi_set_ssid(&sc->wi_net_name, WI_DEFAULT_NETNAME,
253: sizeof(WI_DEFAULT_NETNAME) - 1);
254: (void)wi_set_ssid(&sc->wi_ibss_name, WI_DEFAULT_IBSS,
255: sizeof(WI_DEFAULT_IBSS) - 1);
256:
257: sc->wi_portnum = WI_DEFAULT_PORT;
258: sc->wi_ptype = WI_PORTTYPE_BSS;
259: sc->wi_ap_density = WI_DEFAULT_AP_DENSITY;
260: sc->wi_rts_thresh = WI_DEFAULT_RTS_THRESH;
261: sc->wi_tx_rate = WI_DEFAULT_TX_RATE;
262: sc->wi_max_data_len = WI_DEFAULT_DATALEN;
263: sc->wi_create_ibss = WI_DEFAULT_CREATE_IBSS;
264: sc->wi_pm_enabled = WI_DEFAULT_PM_ENABLED;
265: sc->wi_max_sleep = WI_DEFAULT_MAX_SLEEP;
266: sc->wi_roaming = WI_DEFAULT_ROAMING;
267: sc->wi_authtype = WI_DEFAULT_AUTHTYPE;
268: sc->wi_diversity = WI_DEFAULT_DIVERSITY;
269: sc->wi_crypto_algorithm = WI_CRYPTO_FIRMWARE_WEP;
270:
271: /*
272: * Read the default channel from the NIC. This may vary
273: * depending on the country where the NIC was purchased, so
274: * we can't hard-code a default and expect it to work for
275: * everyone.
276: */
277: gen.wi_type = WI_RID_OWN_CHNL;
278: gen.wi_len = 2;
279: if (wi_read_record(sc, &gen) == 0)
280: sc->wi_channel = letoh16(gen.wi_val);
281: else
282: sc->wi_channel = 3;
283:
284: /*
285: * Set flags based on firmware version.
286: */
287: switch (sc->sc_firmware_type) {
288: case WI_LUCENT:
289: sc->wi_flags |= WI_FLAGS_HAS_ROAMING;
290: if (sc->sc_sta_firmware_ver >= 60000)
291: sc->wi_flags |= WI_FLAGS_HAS_MOR;
292: if (sc->sc_sta_firmware_ver >= 60006) {
293: sc->wi_flags |= WI_FLAGS_HAS_IBSS;
294: sc->wi_flags |= WI_FLAGS_HAS_CREATE_IBSS;
295: }
296: sc->wi_ibss_port = htole16(1);
297: break;
298: case WI_INTERSIL:
299: sc->wi_flags |= WI_FLAGS_HAS_ROAMING;
300: /* older prism firmware is slow so crank the count */
301: if (sc->sc_sta_firmware_ver < 10000)
302: sc->wi_cmd_count = 5000;
303: else
304: sc->wi_cmd_count = 2000;
305: if (sc->sc_sta_firmware_ver >= 800) {
306: #ifndef SMALL_KERNEL
307: /*
308: * USB hostap is more pain than it is worth
309: * for now, things would have to be overhauled
310: */
311: if ((sc->sc_sta_firmware_ver != 10402) &&
312: (!(sc->wi_flags & WI_FLAGS_BUS_USB)))
313: sc->wi_flags |= WI_FLAGS_HAS_HOSTAP;
314: #endif
315: sc->wi_flags |= WI_FLAGS_HAS_IBSS;
316: sc->wi_flags |= WI_FLAGS_HAS_CREATE_IBSS;
317: }
318: if (sc->sc_sta_firmware_ver >= 10603)
319: sc->wi_flags |= WI_FLAGS_HAS_ENH_SECURITY;
320: sc->wi_ibss_port = htole16(0);
321: break;
322: case WI_SYMBOL:
323: sc->wi_flags |= WI_FLAGS_HAS_DIVERSITY;
324: if (sc->sc_sta_firmware_ver >= 20000)
325: sc->wi_flags |= WI_FLAGS_HAS_IBSS;
326: if (sc->sc_sta_firmware_ver >= 25000)
327: sc->wi_flags |= WI_FLAGS_HAS_CREATE_IBSS;
328: sc->wi_ibss_port = htole16(4);
329: break;
330: }
331:
332: /*
333: * Find out if we support WEP on this card.
334: */
335: gen.wi_type = WI_RID_WEP_AVAIL;
336: gen.wi_len = 2;
337: if (wi_read_record(sc, &gen) == 0 && gen.wi_val != htole16(0))
338: sc->wi_flags |= WI_FLAGS_HAS_WEP;
339: timeout_set(&sc->sc_timo, funcs->f_inquire, sc);
340:
341: bzero((char *)&sc->wi_stats, sizeof(sc->wi_stats));
342:
343: /* Find supported rates. */
344: rates.wi_type = WI_RID_DATA_RATES;
345: rates.wi_len = sizeof(rates.wi_rates);
346: if (wi_read_record(sc, (struct wi_ltv_gen *)&rates) == 0) {
347: int i, nrates;
348:
349: nrates = letoh16(*(u_int16_t *)rates.wi_rates);
350: if (nrates > sizeof(rates.wi_rates) - 2)
351: nrates = sizeof(rates.wi_rates) - 2;
352:
353: sc->wi_supprates = 0;
354: for (i = 0; i < nrates; i++)
355: sc->wi_supprates |= rates.wi_rates[2 + i];
356: } else
357: sc->wi_supprates = WI_SUPPRATES_1M | WI_SUPPRATES_2M |
358: WI_SUPPRATES_5M | WI_SUPPRATES_11M;
359:
360: ifmedia_init(&sc->sc_media, 0, wi_media_change, wi_media_status);
361: #define ADD(m, c) ifmedia_add(&sc->sc_media, (m), (c), NULL)
362: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_AUTO, 0, 0), 0);
363: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_AUTO, IFM_IEEE80211_ADHOC, 0), 0);
364: if (sc->wi_flags & WI_FLAGS_HAS_IBSS)
365: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_AUTO, IFM_IEEE80211_IBSS,
366: 0), 0);
367: if (sc->wi_flags & WI_FLAGS_HAS_CREATE_IBSS)
368: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_AUTO,
369: IFM_IEEE80211_IBSSMASTER, 0), 0);
370: if (sc->wi_flags & WI_FLAGS_HAS_HOSTAP)
371: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_AUTO,
372: IFM_IEEE80211_HOSTAP, 0), 0);
373: if (sc->wi_supprates & WI_SUPPRATES_1M) {
374: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS1, 0, 0), 0);
375: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS1,
376: IFM_IEEE80211_ADHOC, 0), 0);
377: if (sc->wi_flags & WI_FLAGS_HAS_IBSS)
378: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS1,
379: IFM_IEEE80211_IBSS, 0), 0);
380: if (sc->wi_flags & WI_FLAGS_HAS_CREATE_IBSS)
381: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS1,
382: IFM_IEEE80211_IBSSMASTER, 0), 0);
383: if (sc->wi_flags & WI_FLAGS_HAS_HOSTAP)
384: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS1,
385: IFM_IEEE80211_HOSTAP, 0), 0);
386: }
387: if (sc->wi_supprates & WI_SUPPRATES_2M) {
388: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS2, 0, 0), 0);
389: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS2,
390: IFM_IEEE80211_ADHOC, 0), 0);
391: if (sc->wi_flags & WI_FLAGS_HAS_IBSS)
392: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS2,
393: IFM_IEEE80211_IBSS, 0), 0);
394: if (sc->wi_flags & WI_FLAGS_HAS_CREATE_IBSS)
395: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS2,
396: IFM_IEEE80211_IBSSMASTER, 0), 0);
397: if (sc->wi_flags & WI_FLAGS_HAS_HOSTAP)
398: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS2,
399: IFM_IEEE80211_HOSTAP, 0), 0);
400: }
401: if (sc->wi_supprates & WI_SUPPRATES_5M) {
402: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS5, 0, 0), 0);
403: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS5,
404: IFM_IEEE80211_ADHOC, 0), 0);
405: if (sc->wi_flags & WI_FLAGS_HAS_IBSS)
406: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS5,
407: IFM_IEEE80211_IBSS, 0), 0);
408: if (sc->wi_flags & WI_FLAGS_HAS_CREATE_IBSS)
409: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS5,
410: IFM_IEEE80211_IBSSMASTER, 0), 0);
411: if (sc->wi_flags & WI_FLAGS_HAS_HOSTAP)
412: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS5,
413: IFM_IEEE80211_HOSTAP, 0), 0);
414: }
415: if (sc->wi_supprates & WI_SUPPRATES_11M) {
416: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS11, 0, 0), 0);
417: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS11,
418: IFM_IEEE80211_ADHOC, 0), 0);
419: if (sc->wi_flags & WI_FLAGS_HAS_IBSS)
420: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS11,
421: IFM_IEEE80211_IBSS, 0), 0);
422: if (sc->wi_flags & WI_FLAGS_HAS_CREATE_IBSS)
423: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS11,
424: IFM_IEEE80211_IBSSMASTER, 0), 0);
425: if (sc->wi_flags & WI_FLAGS_HAS_HOSTAP)
426: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_IEEE80211_DS11,
427: IFM_IEEE80211_HOSTAP, 0), 0);
428: ADD(IFM_MAKEWORD(IFM_IEEE80211, IFM_MANUAL, 0, 0), 0);
429: }
430: #undef ADD
431: ifmedia_set(&sc->sc_media,
432: IFM_MAKEWORD(IFM_IEEE80211, IFM_AUTO, 0, 0));
433:
434: /*
435: * Call MI attach routines.
436: */
437: if_attach(ifp);
438: memcpy(((struct arpcom *)ifp)->ac_enaddr, ic->ic_myaddr,
439: ETHER_ADDR_LEN);
440: ether_ifattach(ifp);
441: printf("\n");
442:
443: sc->wi_flags |= WI_FLAGS_ATTACHED;
444:
445: #if NBPFILTER > 0
446: BPFATTACH(&ifp->if_bpf, ifp, DLT_EN10MB, sizeof(struct ether_header));
447: #endif
448:
449: sc->sc_sdhook = shutdownhook_establish(wi_shutdown, sc);
450:
451: wi_init(sc);
452: wi_stop(sc);
453:
454: return (0);
455: }
456:
457: STATIC void
458: wi_intr_enable(struct wi_softc *sc, int mode)
459: {
460: if (!(sc->wi_flags & WI_FLAGS_BUS_USB))
461: CSR_WRITE_2(sc, WI_INT_EN, mode);
462: }
463:
464: STATIC void
465: wi_intr_ack(struct wi_softc *sc, int mode)
466: {
467: if (!(sc->wi_flags & WI_FLAGS_BUS_USB))
468: CSR_WRITE_2(sc, WI_EVENT_ACK, mode);
469: }
470:
471: int
472: wi_intr(void *vsc)
473: {
474: struct wi_softc *sc = vsc;
475: struct ifnet *ifp;
476: u_int16_t status;
477:
478: DPRINTF(WID_INTR, ("wi_intr: sc %p\n", sc));
479:
480: ifp = &sc->sc_ic.ic_if;
481:
482: if (!(sc->wi_flags & WI_FLAGS_ATTACHED) || !(ifp->if_flags & IFF_UP)) {
483: CSR_WRITE_2(sc, WI_INT_EN, 0);
484: CSR_WRITE_2(sc, WI_EVENT_ACK, 0xffff);
485: return (0);
486: }
487:
488: /* Disable interrupts. */
489: CSR_WRITE_2(sc, WI_INT_EN, 0);
490:
491: status = CSR_READ_2(sc, WI_EVENT_STAT);
492: CSR_WRITE_2(sc, WI_EVENT_ACK, ~WI_INTRS);
493:
494: if (status & WI_EV_RX) {
495: wi_rxeof(sc);
496: CSR_WRITE_2(sc, WI_EVENT_ACK, WI_EV_RX);
497: }
498:
499: if (status & WI_EV_TX) {
500: wi_txeof(sc, status);
501: CSR_WRITE_2(sc, WI_EVENT_ACK, WI_EV_TX);
502: }
503:
504: if (status & WI_EV_ALLOC) {
505: int id;
506: id = CSR_READ_2(sc, WI_ALLOC_FID);
507: CSR_WRITE_2(sc, WI_EVENT_ACK, WI_EV_ALLOC);
508: if (id == sc->wi_tx_data_id)
509: wi_txeof(sc, status);
510: }
511:
512: if (status & WI_EV_INFO) {
513: wi_update_stats(sc);
514: CSR_WRITE_2(sc, WI_EVENT_ACK, WI_EV_INFO);
515: }
516:
517: if (status & WI_EV_TX_EXC) {
518: wi_txeof(sc, status);
519: CSR_WRITE_2(sc, WI_EVENT_ACK, WI_EV_TX_EXC);
520: }
521:
522: if (status & WI_EV_INFO_DROP) {
523: CSR_WRITE_2(sc, WI_EVENT_ACK, WI_EV_INFO_DROP);
524: }
525:
526: /* Re-enable interrupts. */
527: CSR_WRITE_2(sc, WI_INT_EN, WI_INTRS);
528:
529: if (!IFQ_IS_EMPTY(&ifp->if_snd))
530: wi_start(ifp);
531:
532: return (1);
533: }
534:
535: STATIC int
536: wi_get_fid_io(struct wi_softc *sc, int fid)
537: {
538: return CSR_READ_2(sc, fid);
539: }
540:
541:
542: void
543: wi_rxeof(struct wi_softc *sc)
544: {
545: struct ifnet *ifp;
546: struct ether_header *eh;
547: struct mbuf *m;
548: caddr_t olddata;
549: u_int16_t ftype;
550: int maxlen;
551: int id;
552:
553: ifp = &sc->sc_ic.ic_if;
554:
555: id = wi_get_fid(sc, WI_RX_FID);
556:
557: if (sc->wi_procframe || sc->wi_debug.wi_monitor) {
558: struct wi_frame *rx_frame;
559: int datlen, hdrlen;
560:
561: MGETHDR(m, M_DONTWAIT, MT_DATA);
562: if (m == NULL) {
563: ifp->if_ierrors++;
564: return;
565: }
566: MCLGET(m, M_DONTWAIT);
567: if (!(m->m_flags & M_EXT)) {
568: m_freem(m);
569: ifp->if_ierrors++;
570: return;
571: }
572:
573: m->m_pkthdr.rcvif = ifp;
574:
575: if (wi_read_data(sc, id, 0, mtod(m, caddr_t),
576: sizeof(struct wi_frame))) {
577: m_freem(m);
578: ifp->if_ierrors++;
579: return;
580: }
581:
582: rx_frame = mtod(m, struct wi_frame *);
583:
584: if (rx_frame->wi_status & htole16(WI_STAT_BADCRC)) {
585: m_freem(m);
586: ifp->if_ierrors++;
587: return;
588: }
589:
590: switch ((letoh16(rx_frame->wi_status) & WI_STAT_MAC_PORT)
591: >> 8) {
592: case 7:
593: switch (letoh16(rx_frame->wi_frame_ctl) &
594: WI_FCTL_FTYPE) {
595: case WI_FTYPE_DATA:
596: hdrlen = WI_DATA_HDRLEN;
597: datlen = letoh16(rx_frame->wi_dat_len);
598: break;
599: case WI_FTYPE_MGMT:
600: hdrlen = WI_MGMT_HDRLEN;
601: datlen = letoh16(rx_frame->wi_dat_len);
602: break;
603: case WI_FTYPE_CTL:
604: hdrlen = WI_CTL_HDRLEN;
605: datlen = 0;
606: break;
607: default:
608: printf(WI_PRT_FMT ": received packet of "
609: "unknown type on port 7\n", WI_PRT_ARG(sc));
610: m_freem(m);
611: ifp->if_ierrors++;
612: return;
613: }
614: break;
615: case 0:
616: hdrlen = WI_DATA_HDRLEN;
617: datlen = letoh16(rx_frame->wi_dat_len);
618: break;
619: default:
620: printf(WI_PRT_FMT ": received packet on invalid port "
621: "(wi_status=0x%x)\n", WI_PRT_ARG(sc),
622: letoh16(rx_frame->wi_status));
623: m_freem(m);
624: ifp->if_ierrors++;
625: return;
626: }
627:
628: if ((hdrlen + datlen + 2) > MCLBYTES) {
629: m_freem(m);
630: ifp->if_ierrors++;
631: return;
632: }
633:
634: if (wi_read_data(sc, id, hdrlen, mtod(m, caddr_t) + hdrlen,
635: datlen + 2)) {
636: m_freem(m);
637: ifp->if_ierrors++;
638: return;
639: }
640:
641: m->m_pkthdr.len = m->m_len = hdrlen + datlen;
642: } else {
643: struct wi_frame rx_frame;
644:
645: /* First read in the frame header */
646: if (wi_read_data(sc, id, 0, (caddr_t)&rx_frame,
647: sizeof(rx_frame))) {
648: ifp->if_ierrors++;
649: return;
650: }
651:
652: /* Drop undecryptable or packets with receive errors here */
653: if (rx_frame.wi_status & htole16(WI_STAT_ERRSTAT)) {
654: ifp->if_ierrors++;
655: return;
656: }
657:
658: /* Stash frame type in host byte order for later use */
659: ftype = letoh16(rx_frame.wi_frame_ctl) & WI_FCTL_FTYPE;
660:
661: MGETHDR(m, M_DONTWAIT, MT_DATA);
662: if (m == NULL) {
663: ifp->if_ierrors++;
664: return;
665: }
666: MCLGET(m, M_DONTWAIT);
667: if (!(m->m_flags & M_EXT)) {
668: m_freem(m);
669: ifp->if_ierrors++;
670: return;
671: }
672:
673: olddata = m->m_data;
674: /* Align the data after the ethernet header */
675: m->m_data = (caddr_t)ALIGN(m->m_data +
676: sizeof(struct ether_header)) - sizeof(struct ether_header);
677:
678: eh = mtod(m, struct ether_header *);
679: maxlen = MCLBYTES - (m->m_data - olddata);
680: m->m_pkthdr.rcvif = ifp;
681:
682: if (ftype == WI_FTYPE_MGMT &&
683: sc->wi_ptype == WI_PORTTYPE_HOSTAP) {
684:
685: u_int16_t rxlen = letoh16(rx_frame.wi_dat_len);
686:
687: if ((WI_802_11_OFFSET_RAW + rxlen + 2) > maxlen) {
688: printf("%s: oversized mgmt packet received in "
689: "hostap mode (wi_dat_len=%d, "
690: "wi_status=0x%x)\n", sc->sc_dev.dv_xname,
691: rxlen, letoh16(rx_frame.wi_status));
692: m_freem(m);
693: ifp->if_ierrors++;
694: return;
695: }
696:
697: /* Put the whole header in there. */
698: bcopy(&rx_frame, mtod(m, void *),
699: sizeof(struct wi_frame));
700: if (wi_read_data(sc, id, WI_802_11_OFFSET_RAW,
701: mtod(m, caddr_t) + WI_802_11_OFFSET_RAW,
702: rxlen + 2)) {
703: m_freem(m);
704: if (sc->sc_ic.ic_if.if_flags & IFF_DEBUG)
705: printf("wihap: failed to copy header\n");
706: ifp->if_ierrors++;
707: return;
708: }
709:
710: m->m_pkthdr.len = m->m_len =
711: WI_802_11_OFFSET_RAW + rxlen;
712:
713: /* XXX: consider giving packet to bhp? */
714:
715: wihap_mgmt_input(sc, &rx_frame, m);
716:
717: return;
718: }
719:
720: switch (letoh16(rx_frame.wi_status) & WI_RXSTAT_MSG_TYPE) {
721: case WI_STAT_1042:
722: case WI_STAT_TUNNEL:
723: case WI_STAT_WMP_MSG:
724: if ((letoh16(rx_frame.wi_dat_len) + WI_SNAPHDR_LEN) >
725: maxlen) {
726: printf(WI_PRT_FMT ": oversized packet received "
727: "(wi_dat_len=%d, wi_status=0x%x)\n",
728: WI_PRT_ARG(sc),
729: letoh16(rx_frame.wi_dat_len),
730: letoh16(rx_frame.wi_status));
731: m_freem(m);
732: ifp->if_ierrors++;
733: return;
734: }
735: m->m_pkthdr.len = m->m_len =
736: letoh16(rx_frame.wi_dat_len) + WI_SNAPHDR_LEN;
737:
738: bcopy((char *)&rx_frame.wi_dst_addr,
739: (char *)&eh->ether_dhost, ETHER_ADDR_LEN);
740: bcopy((char *)&rx_frame.wi_src_addr,
741: (char *)&eh->ether_shost, ETHER_ADDR_LEN);
742: bcopy((char *)&rx_frame.wi_type,
743: (char *)&eh->ether_type, ETHER_TYPE_LEN);
744:
745: if (wi_read_data(sc, id, WI_802_11_OFFSET,
746: mtod(m, caddr_t) + sizeof(struct ether_header),
747: m->m_len + 2)) {
748: ifp->if_ierrors++;
749: m_freem(m);
750: return;
751: }
752: break;
753: default:
754: if ((letoh16(rx_frame.wi_dat_len) +
755: sizeof(struct ether_header)) > maxlen) {
756: printf(WI_PRT_FMT ": oversized packet received "
757: "(wi_dat_len=%d, wi_status=0x%x)\n",
758: WI_PRT_ARG(sc),
759: letoh16(rx_frame.wi_dat_len),
760: letoh16(rx_frame.wi_status));
761: m_freem(m);
762: ifp->if_ierrors++;
763: return;
764: }
765: m->m_pkthdr.len = m->m_len =
766: letoh16(rx_frame.wi_dat_len) +
767: sizeof(struct ether_header);
768:
769: if (wi_read_data(sc, id, WI_802_3_OFFSET,
770: mtod(m, caddr_t), m->m_len + 2)) {
771: m_freem(m);
772: ifp->if_ierrors++;
773: return;
774: }
775: break;
776: }
777:
778: ifp->if_ipackets++;
779:
780: if (sc->wi_use_wep &&
781: rx_frame.wi_frame_ctl & htole16(WI_FCTL_WEP)) {
782: int len;
783:
784: switch (sc->wi_crypto_algorithm) {
785: case WI_CRYPTO_FIRMWARE_WEP:
786: break;
787: case WI_CRYPTO_SOFTWARE_WEP:
788: m_copydata(m, 0, m->m_pkthdr.len,
789: (caddr_t)sc->wi_rxbuf);
790: len = m->m_pkthdr.len -
791: sizeof(struct ether_header);
792: if (wi_do_hostdecrypt(sc, sc->wi_rxbuf +
793: sizeof(struct ether_header), len)) {
794: if (sc->sc_ic.ic_if.if_flags & IFF_DEBUG)
795: printf(WI_PRT_FMT ": Error decrypting incoming packet.\n", WI_PRT_ARG(sc));
796: m_freem(m);
797: ifp->if_ierrors++;
798: return;
799: }
800: len -= IEEE80211_WEP_IVLEN +
801: IEEE80211_WEP_KIDLEN + IEEE80211_WEP_CRCLEN;
802: /*
803: * copy data back to mbufs:
804: * we need to ditch the IV & most LLC/SNAP stuff
805: * (except SNAP type, we're going use that to
806: * overwrite the ethertype in the ether_header)
807: */
808: m_copyback(m, sizeof(struct ether_header) -
809: WI_ETHERTYPE_LEN, WI_ETHERTYPE_LEN +
810: (len - WI_SNAPHDR_LEN),
811: sc->wi_rxbuf + sizeof(struct ether_header) +
812: IEEE80211_WEP_IVLEN +
813: IEEE80211_WEP_KIDLEN + WI_SNAPHDR_LEN);
814: m_adj(m, -(WI_ETHERTYPE_LEN +
815: IEEE80211_WEP_IVLEN + IEEE80211_WEP_KIDLEN +
816: WI_SNAPHDR_LEN));
817: break;
818: }
819: }
820:
821: if (sc->wi_ptype == WI_PORTTYPE_HOSTAP) {
822: /*
823: * Give host AP code first crack at data packets.
824: * If it decides to handle it (or drop it), it will
825: * return a non-zero. Otherwise, it is destined for
826: * this host.
827: */
828: if (wihap_data_input(sc, &rx_frame, m))
829: return;
830: }
831: }
832:
833: #if NBPFILTER > 0
834: /* Handle BPF listeners. */
835: if (ifp->if_bpf)
836: bpf_mtap(ifp->if_bpf, m, BPF_DIRECTION_IN);
837: #endif
838:
839: /* Receive packet unless in procframe or monitor mode. */
840: if (sc->wi_procframe || sc->wi_debug.wi_monitor)
841: m_freem(m);
842: else
843: ether_input_mbuf(ifp, m);
844:
845: return;
846: }
847:
848: void
849: wi_txeof(struct wi_softc *sc, int status)
850: {
851: struct ifnet *ifp;
852:
853: ifp = &sc->sc_ic.ic_if;
854:
855: ifp->if_timer = 0;
856: ifp->if_flags &= ~IFF_OACTIVE;
857:
858: if (status & WI_EV_TX_EXC)
859: ifp->if_oerrors++;
860: else
861: ifp->if_opackets++;
862:
863: return;
864: }
865:
866: void
867: wi_inquire(void *xsc)
868: {
869: struct wi_softc *sc;
870: struct ifnet *ifp;
871: int s, rv;
872:
873: sc = xsc;
874: ifp = &sc->sc_ic.ic_if;
875:
876: timeout_add(&sc->sc_timo, hz * 60);
877:
878: /* Don't do this while we're transmitting */
879: if (ifp->if_flags & IFF_OACTIVE)
880: return;
881:
882: s = splnet();
883: rv = wi_cmd(sc, WI_CMD_INQUIRE, WI_INFO_COUNTERS, 0, 0);
884: splx(s);
885: if (rv)
886: printf(WI_PRT_FMT ": wi_cmd failed with %d\n", WI_PRT_ARG(sc),
887: rv);
888:
889: return;
890: }
891:
892: void
893: wi_update_stats(struct wi_softc *sc)
894: {
895: struct wi_ltv_gen gen;
896: u_int16_t id;
897: struct ifnet *ifp;
898: u_int32_t *ptr;
899: int len, i;
900: u_int16_t t;
901:
902: ifp = &sc->sc_ic.ic_if;
903:
904: id = wi_get_fid(sc, WI_INFO_FID);
905:
906: wi_read_data(sc, id, 0, (char *)&gen, 4);
907:
908: if (gen.wi_type == htole16(WI_INFO_SCAN_RESULTS)) {
909: sc->wi_scanbuf_len = letoh16(gen.wi_len);
910: wi_read_data(sc, id, 4, (caddr_t)sc->wi_scanbuf,
911: sc->wi_scanbuf_len * 2);
912: return;
913: } else if (gen.wi_type != htole16(WI_INFO_COUNTERS))
914: return;
915:
916: /* Some card versions have a larger stats structure */
917: len = (letoh16(gen.wi_len) - 1 < sizeof(sc->wi_stats) / 4) ?
918: letoh16(gen.wi_len) - 1 : sizeof(sc->wi_stats) / 4;
919:
920: ptr = (u_int32_t *)&sc->wi_stats;
921:
922: for (i = 0; i < len; i++) {
923: if (sc->wi_flags & WI_FLAGS_BUS_USB) {
924: wi_read_data(sc, id, 4 + i*2, (char *)&t, 2);
925: t = letoh16(t);
926: } else
927: t = CSR_READ_2(sc, WI_DATA1);
928: #ifdef WI_HERMES_STATS_WAR
929: if (t > 0xF000)
930: t = ~t & 0xFFFF;
931: #endif
932: ptr[i] += t;
933: }
934:
935: ifp->if_collisions = sc->wi_stats.wi_tx_single_retries +
936: sc->wi_stats.wi_tx_multi_retries +
937: sc->wi_stats.wi_tx_retry_limit;
938:
939: return;
940: }
941:
942: STATIC int
943: wi_cmd_io(struct wi_softc *sc, int cmd, int val0, int val1, int val2)
944: {
945: int i, s = 0;
946:
947: /* Wait for the busy bit to clear. */
948: for (i = sc->wi_cmd_count; i--; DELAY(1000)) {
949: if (!(CSR_READ_2(sc, WI_COMMAND) & WI_CMD_BUSY))
950: break;
951: }
952: if (i < 0) {
953: if (sc->sc_ic.ic_if.if_flags & IFF_DEBUG)
954: printf(WI_PRT_FMT ": wi_cmd_io: busy bit won't clear\n",
955: WI_PRT_ARG(sc));
956: return(ETIMEDOUT);
957: }
958:
959: CSR_WRITE_2(sc, WI_PARAM0, val0);
960: CSR_WRITE_2(sc, WI_PARAM1, val1);
961: CSR_WRITE_2(sc, WI_PARAM2, val2);
962: CSR_WRITE_2(sc, WI_COMMAND, cmd);
963:
964: for (i = WI_TIMEOUT; i--; DELAY(WI_DELAY)) {
965: /*
966: * Wait for 'command complete' bit to be
967: * set in the event status register.
968: */
969: s = CSR_READ_2(sc, WI_EVENT_STAT) & WI_EV_CMD;
970: if (s) {
971: /* Ack the event and read result code. */
972: s = CSR_READ_2(sc, WI_STATUS);
973: CSR_WRITE_2(sc, WI_EVENT_ACK, WI_EV_CMD);
974: if (s & WI_STAT_CMD_RESULT)
975: return(EIO);
976: break;
977: }
978: }
979:
980: if (i < 0) {
981: if (sc->sc_ic.ic_if.if_flags & IFF_DEBUG)
982: printf(WI_PRT_FMT
983: ": timeout in wi_cmd 0x%04x; event status 0x%04x\n",
984: WI_PRT_ARG(sc), cmd, s);
985: return(ETIMEDOUT);
986: }
987:
988: return(0);
989: }
990:
991: STATIC void
992: wi_reset(struct wi_softc *sc)
993: {
994: int error, tries = 3;
995:
996: DPRINTF(WID_RESET, ("wi_reset: sc %p\n", sc));
997:
998: /* Symbol firmware cannot be initialized more than once. */
999: if (sc->sc_firmware_type == WI_SYMBOL) {
1000: if (sc->wi_flags & WI_FLAGS_INITIALIZED)
1001: return;
1002: tries = 1;
1003: }
1004:
1005: for (; tries--; DELAY(WI_DELAY * 1000)) {
1006: if ((error = wi_cmd(sc, WI_CMD_INI, 0, 0, 0)) == 0)
1007: break;
1008: }
1009: if (tries < 0) {
1010: printf(WI_PRT_FMT ": init failed\n", WI_PRT_ARG(sc));
1011: return;
1012: }
1013: sc->wi_flags |= WI_FLAGS_INITIALIZED;
1014:
1015: wi_intr_enable(sc, 0);
1016: wi_intr_ack(sc, 0xffff);
1017:
1018: /* Calibrate timer. */
1019: WI_SETVAL(WI_RID_TICK_TIME, 8);
1020:
1021: return;
1022: }
1023:
1024: STATIC void
1025: wi_cor_reset(struct wi_softc *sc)
1026: {
1027: u_int8_t cor_value;
1028:
1029: DPRINTF(WID_RESET, ("wi_cor_reset: sc %p\n", sc));
1030:
1031: /*
1032: * Do a soft reset of the card; this is required for Symbol cards.
1033: * This shouldn't hurt other cards but there have been reports
1034: * of the COR reset messing up old Lucent firmware revisions so
1035: * we avoid soft reset on Lucent cards for now.
1036: */
1037: if (sc->sc_firmware_type != WI_LUCENT) {
1038: cor_value = bus_space_read_1(sc->wi_ltag, sc->wi_lhandle,
1039: sc->wi_cor_offset);
1040: bus_space_write_1(sc->wi_ltag, sc->wi_lhandle,
1041: sc->wi_cor_offset, (cor_value | WI_COR_SOFT_RESET));
1042: DELAY(1000);
1043: bus_space_write_1(sc->wi_ltag, sc->wi_lhandle,
1044: sc->wi_cor_offset, (cor_value & ~WI_COR_SOFT_RESET));
1045: DELAY(1000);
1046: }
1047:
1048: return;
1049: }
1050:
1051: /*
1052: * Read an LTV record from the NIC.
1053: */
1054: STATIC int
1055: wi_read_record_io(struct wi_softc *sc, struct wi_ltv_gen *ltv)
1056: {
1057: u_int8_t *ptr;
1058: int len, code;
1059: struct wi_ltv_gen *oltv, p2ltv;
1060:
1061: if (sc->sc_firmware_type != WI_LUCENT) {
1062: oltv = ltv;
1063: switch (ltv->wi_type) {
1064: case WI_RID_ENCRYPTION:
1065: p2ltv.wi_type = WI_RID_P2_ENCRYPTION;
1066: p2ltv.wi_len = 2;
1067: ltv = &p2ltv;
1068: break;
1069: case WI_RID_TX_CRYPT_KEY:
1070: if (ltv->wi_val > WI_NLTV_KEYS)
1071: return (EINVAL);
1072: p2ltv.wi_type = WI_RID_P2_TX_CRYPT_KEY;
1073: p2ltv.wi_len = 2;
1074: ltv = &p2ltv;
1075: break;
1076: }
1077: }
1078:
1079: /* Tell the NIC to enter record read mode. */
1080: if (wi_cmd(sc, WI_CMD_ACCESS|WI_ACCESS_READ, ltv->wi_type, 0, 0))
1081: return(EIO);
1082:
1083: /* Seek to the record. */
1084: if (wi_seek(sc, ltv->wi_type, 0, WI_BAP1))
1085: return(EIO);
1086:
1087: /*
1088: * Read the length and record type and make sure they
1089: * match what we expect (this verifies that we have enough
1090: * room to hold all of the returned data).
1091: */
1092: len = CSR_READ_2(sc, WI_DATA1);
1093: if (len > ltv->wi_len)
1094: return(ENOSPC);
1095: code = CSR_READ_2(sc, WI_DATA1);
1096: if (code != ltv->wi_type)
1097: return(EIO);
1098:
1099: ltv->wi_len = len;
1100: ltv->wi_type = code;
1101:
1102: /* Now read the data. */
1103: ptr = (u_int8_t *)<v->wi_val;
1104: if (ltv->wi_len > 1)
1105: CSR_READ_RAW_2(sc, WI_DATA1, ptr, (ltv->wi_len-1)*2);
1106:
1107: if (ltv->wi_type == WI_RID_PORTTYPE && sc->wi_ptype == WI_PORTTYPE_IBSS
1108: && ltv->wi_val == sc->wi_ibss_port) {
1109: /*
1110: * Convert vendor IBSS port type to WI_PORTTYPE_IBSS.
1111: * Since Lucent uses port type 1 for BSS *and* IBSS we
1112: * have to rely on wi_ptype to distinguish this for us.
1113: */
1114: ltv->wi_val = htole16(WI_PORTTYPE_IBSS);
1115: } else if (sc->sc_firmware_type != WI_LUCENT) {
1116: int v;
1117:
1118: switch (oltv->wi_type) {
1119: case WI_RID_TX_RATE:
1120: case WI_RID_CUR_TX_RATE:
1121: switch (letoh16(ltv->wi_val)) {
1122: case 1: v = 1; break;
1123: case 2: v = 2; break;
1124: case 3: v = 6; break;
1125: case 4: v = 5; break;
1126: case 7: v = 7; break;
1127: case 8: v = 11; break;
1128: case 15: v = 3; break;
1129: default: v = 0x100 + letoh16(ltv->wi_val); break;
1130: }
1131: oltv->wi_val = htole16(v);
1132: break;
1133: case WI_RID_ENCRYPTION:
1134: oltv->wi_len = 2;
1135: if (ltv->wi_val & htole16(0x01))
1136: oltv->wi_val = htole16(1);
1137: else
1138: oltv->wi_val = htole16(0);
1139: break;
1140: case WI_RID_TX_CRYPT_KEY:
1141: case WI_RID_CNFAUTHMODE:
1142: oltv->wi_len = 2;
1143: oltv->wi_val = ltv->wi_val;
1144: break;
1145: }
1146: }
1147:
1148: return(0);
1149: }
1150:
1151: /*
1152: * Same as read, except we inject data instead of reading it.
1153: */
1154: STATIC int
1155: wi_write_record_io(struct wi_softc *sc, struct wi_ltv_gen *ltv)
1156: {
1157: u_int8_t *ptr;
1158: u_int16_t val = 0;
1159: int i;
1160: struct wi_ltv_gen p2ltv;
1161:
1162: if (ltv->wi_type == WI_RID_PORTTYPE &&
1163: letoh16(ltv->wi_val) == WI_PORTTYPE_IBSS) {
1164: /* Convert WI_PORTTYPE_IBSS to vendor IBSS port type. */
1165: p2ltv.wi_type = WI_RID_PORTTYPE;
1166: p2ltv.wi_len = 2;
1167: p2ltv.wi_val = sc->wi_ibss_port;
1168: ltv = &p2ltv;
1169: } else if (sc->sc_firmware_type != WI_LUCENT) {
1170: int v;
1171:
1172: switch (ltv->wi_type) {
1173: case WI_RID_TX_RATE:
1174: p2ltv.wi_type = WI_RID_TX_RATE;
1175: p2ltv.wi_len = 2;
1176: switch (letoh16(ltv->wi_val)) {
1177: case 1: v = 1; break;
1178: case 2: v = 2; break;
1179: case 3: v = 15; break;
1180: case 5: v = 4; break;
1181: case 6: v = 3; break;
1182: case 7: v = 7; break;
1183: case 11: v = 8; break;
1184: default: return EINVAL;
1185: }
1186: p2ltv.wi_val = htole16(v);
1187: ltv = &p2ltv;
1188: break;
1189: case WI_RID_ENCRYPTION:
1190: p2ltv.wi_type = WI_RID_P2_ENCRYPTION;
1191: p2ltv.wi_len = 2;
1192: if (ltv->wi_val & htole16(0x01)) {
1193: val = PRIVACY_INVOKED;
1194: /*
1195: * If using shared key WEP we must set the
1196: * EXCLUDE_UNENCRYPTED bit. Symbol cards
1197: * need this bit set even when not using
1198: * shared key. We can't just test for
1199: * IEEE80211_AUTH_SHARED since Symbol cards
1200: * have 2 shared key modes.
1201: */
1202: if (sc->wi_authtype != IEEE80211_AUTH_OPEN ||
1203: sc->sc_firmware_type == WI_SYMBOL)
1204: val |= EXCLUDE_UNENCRYPTED;
1205:
1206: switch (sc->wi_crypto_algorithm) {
1207: case WI_CRYPTO_FIRMWARE_WEP:
1208: /*
1209: * TX encryption is broken in
1210: * Host AP mode.
1211: */
1212: if (sc->wi_ptype == WI_PORTTYPE_HOSTAP)
1213: val |= HOST_ENCRYPT;
1214: break;
1215: case WI_CRYPTO_SOFTWARE_WEP:
1216: val |= HOST_ENCRYPT|HOST_DECRYPT;
1217: break;
1218: }
1219: p2ltv.wi_val = htole16(val);
1220: } else
1221: p2ltv.wi_val = htole16(HOST_ENCRYPT | HOST_DECRYPT);
1222: ltv = &p2ltv;
1223: break;
1224: case WI_RID_TX_CRYPT_KEY:
1225: if (ltv->wi_val > WI_NLTV_KEYS)
1226: return (EINVAL);
1227: p2ltv.wi_type = WI_RID_P2_TX_CRYPT_KEY;
1228: p2ltv.wi_len = 2;
1229: p2ltv.wi_val = ltv->wi_val;
1230: ltv = &p2ltv;
1231: break;
1232: case WI_RID_DEFLT_CRYPT_KEYS: {
1233: int error;
1234: int keylen;
1235: struct wi_ltv_str ws;
1236: struct wi_ltv_keys *wk = (struct wi_ltv_keys *)ltv;
1237:
1238: keylen = wk->wi_keys[sc->wi_tx_key].wi_keylen;
1239: keylen = letoh16(keylen);
1240:
1241: for (i = 0; i < 4; i++) {
1242: bzero(&ws, sizeof(ws));
1243: ws.wi_len = (keylen > 5) ? 8 : 4;
1244: ws.wi_type = WI_RID_P2_CRYPT_KEY0 + i;
1245: bcopy(&wk->wi_keys[i].wi_keydat,
1246: ws.wi_str, keylen);
1247: error = wi_write_record(sc,
1248: (struct wi_ltv_gen *)&ws);
1249: if (error)
1250: return (error);
1251: }
1252: }
1253: return (0);
1254: }
1255: }
1256:
1257: if (wi_seek(sc, ltv->wi_type, 0, WI_BAP1))
1258: return(EIO);
1259:
1260: CSR_WRITE_2(sc, WI_DATA1, ltv->wi_len);
1261: CSR_WRITE_2(sc, WI_DATA1, ltv->wi_type);
1262:
1263: ptr = (u_int8_t *)<v->wi_val;
1264: if (ltv->wi_len > 1)
1265: CSR_WRITE_RAW_2(sc, WI_DATA1, ptr, (ltv->wi_len-1) *2);
1266:
1267: if (wi_cmd(sc, WI_CMD_ACCESS|WI_ACCESS_WRITE, ltv->wi_type, 0, 0))
1268: return(EIO);
1269:
1270: return(0);
1271: }
1272:
1273: STATIC int
1274: wi_seek(struct wi_softc *sc, int id, int off, int chan)
1275: {
1276: int i;
1277: int selreg, offreg;
1278:
1279: switch (chan) {
1280: case WI_BAP0:
1281: selreg = WI_SEL0;
1282: offreg = WI_OFF0;
1283: break;
1284: case WI_BAP1:
1285: selreg = WI_SEL1;
1286: offreg = WI_OFF1;
1287: break;
1288: default:
1289: printf(WI_PRT_FMT ": invalid data path: %x\n", WI_PRT_ARG(sc),
1290: chan);
1291: return(EIO);
1292: }
1293:
1294: CSR_WRITE_2(sc, selreg, id);
1295: CSR_WRITE_2(sc, offreg, off);
1296:
1297: for (i = WI_TIMEOUT; i--; DELAY(1))
1298: if (!(CSR_READ_2(sc, offreg) & (WI_OFF_BUSY|WI_OFF_ERR)))
1299: break;
1300:
1301: if (i < 0)
1302: return(ETIMEDOUT);
1303:
1304: return(0);
1305: }
1306:
1307: STATIC int
1308: wi_read_data_io(struct wi_softc *sc, int id, int off, caddr_t buf, int len)
1309: {
1310: u_int8_t *ptr;
1311:
1312: if (wi_seek(sc, id, off, WI_BAP1))
1313: return(EIO);
1314:
1315: ptr = (u_int8_t *)buf;
1316: CSR_READ_RAW_2(sc, WI_DATA1, ptr, len);
1317:
1318: return(0);
1319: }
1320:
1321: /*
1322: * According to the comments in the HCF Light code, there is a bug in
1323: * the Hermes (or possibly in certain Hermes firmware revisions) where
1324: * the chip's internal autoincrement counter gets thrown off during
1325: * data writes: the autoincrement is missed, causing one data word to
1326: * be overwritten and subsequent words to be written to the wrong memory
1327: * locations. The end result is that we could end up transmitting bogus
1328: * frames without realizing it. The workaround for this is to write a
1329: * couple of extra guard words after the end of the transfer, then
1330: * attempt to read then back. If we fail to locate the guard words where
1331: * we expect them, we preform the transfer over again.
1332: */
1333: STATIC int
1334: wi_write_data_io(struct wi_softc *sc, int id, int off, caddr_t buf, int len)
1335: {
1336: u_int8_t *ptr;
1337:
1338: #ifdef WI_HERMES_AUTOINC_WAR
1339: again:
1340: #endif
1341:
1342: if (wi_seek(sc, id, off, WI_BAP0))
1343: return(EIO);
1344:
1345: ptr = (u_int8_t *)buf;
1346: CSR_WRITE_RAW_2(sc, WI_DATA0, ptr, len);
1347:
1348: #ifdef WI_HERMES_AUTOINC_WAR
1349: CSR_WRITE_2(sc, WI_DATA0, 0x1234);
1350: CSR_WRITE_2(sc, WI_DATA0, 0x5678);
1351:
1352: if (wi_seek(sc, id, off + len, WI_BAP0))
1353: return(EIO);
1354:
1355: if (CSR_READ_2(sc, WI_DATA0) != 0x1234 ||
1356: CSR_READ_2(sc, WI_DATA0) != 0x5678)
1357: goto again;
1358: #endif
1359:
1360: return(0);
1361: }
1362:
1363: /*
1364: * Allocate a region of memory inside the NIC and zero
1365: * it out.
1366: */
1367: STATIC int
1368: wi_alloc_nicmem_io(struct wi_softc *sc, int len, int *id)
1369: {
1370: int i;
1371:
1372: if (wi_cmd(sc, WI_CMD_ALLOC_MEM, len, 0, 0)) {
1373: printf(WI_PRT_FMT ": failed to allocate %d bytes on NIC\n",
1374: WI_PRT_ARG(sc), len);
1375: return(ENOMEM);
1376: }
1377:
1378: for (i = WI_TIMEOUT; i--; DELAY(1)) {
1379: if (CSR_READ_2(sc, WI_EVENT_STAT) & WI_EV_ALLOC)
1380: break;
1381: }
1382:
1383: if (i < 0)
1384: return(ETIMEDOUT);
1385:
1386: *id = CSR_READ_2(sc, WI_ALLOC_FID);
1387: CSR_WRITE_2(sc, WI_EVENT_ACK, WI_EV_ALLOC);
1388:
1389: if (wi_seek(sc, *id, 0, WI_BAP0))
1390: return(EIO);
1391:
1392: for (i = 0; i < len / 2; i++)
1393: CSR_WRITE_2(sc, WI_DATA0, 0);
1394:
1395: return(0);
1396: }
1397:
1398: STATIC void
1399: wi_setmulti(struct wi_softc *sc)
1400: {
1401: struct ifnet *ifp;
1402: int i = 0;
1403: struct wi_ltv_mcast mcast;
1404: struct ether_multistep step;
1405: struct ether_multi *enm;
1406:
1407: ifp = &sc->sc_ic.ic_if;
1408:
1409: bzero((char *)&mcast, sizeof(mcast));
1410:
1411: mcast.wi_type = WI_RID_MCAST_LIST;
1412: mcast.wi_len = ((ETHER_ADDR_LEN / 2) * 16) + 1;
1413:
1414: allmulti:
1415: if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) {
1416: wi_write_record(sc, (struct wi_ltv_gen *)&mcast);
1417: return;
1418: }
1419:
1420: ETHER_FIRST_MULTI(step, &sc->sc_ic.ic_ac, enm);
1421: while (enm != NULL) {
1422: if (i >= 16) {
1423: bzero((char *)&mcast, sizeof(mcast));
1424: break;
1425: }
1426:
1427: if (bcmp(enm->enm_addrlo, enm->enm_addrhi, ETHER_ADDR_LEN)) {
1428: ifp->if_flags |= IFF_ALLMULTI;
1429: goto allmulti;
1430: }
1431: bcopy(enm->enm_addrlo, (char *)&mcast.wi_mcast[i],
1432: ETHER_ADDR_LEN);
1433: i++;
1434: ETHER_NEXT_MULTI(step, enm);
1435: }
1436:
1437: mcast.wi_len = (i * 3) + 1;
1438: wi_write_record(sc, (struct wi_ltv_gen *)&mcast);
1439:
1440: return;
1441: }
1442:
1443: STATIC int
1444: wi_setdef(struct wi_softc *sc, struct wi_req *wreq)
1445: {
1446: struct ifnet *ifp;
1447: int error = 0;
1448:
1449: ifp = &sc->sc_ic.ic_if;
1450:
1451: switch(wreq->wi_type) {
1452: case WI_RID_MAC_NODE:
1453: bcopy((char *)&wreq->wi_val, LLADDR(ifp->if_sadl),
1454: ETHER_ADDR_LEN);
1455: bcopy((char *)&wreq->wi_val, (char *)&sc->sc_ic.ic_myaddr,
1456: ETHER_ADDR_LEN);
1457: break;
1458: case WI_RID_PORTTYPE:
1459: error = wi_sync_media(sc, letoh16(wreq->wi_val[0]),
1460: sc->wi_tx_rate);
1461: break;
1462: case WI_RID_TX_RATE:
1463: error = wi_sync_media(sc, sc->wi_ptype,
1464: letoh16(wreq->wi_val[0]));
1465: break;
1466: case WI_RID_MAX_DATALEN:
1467: sc->wi_max_data_len = letoh16(wreq->wi_val[0]);
1468: break;
1469: case WI_RID_RTS_THRESH:
1470: sc->wi_rts_thresh = letoh16(wreq->wi_val[0]);
1471: break;
1472: case WI_RID_SYSTEM_SCALE:
1473: sc->wi_ap_density = letoh16(wreq->wi_val[0]);
1474: break;
1475: case WI_RID_CREATE_IBSS:
1476: sc->wi_create_ibss = letoh16(wreq->wi_val[0]);
1477: error = wi_sync_media(sc, sc->wi_ptype, sc->wi_tx_rate);
1478: break;
1479: case WI_RID_OWN_CHNL:
1480: sc->wi_channel = letoh16(wreq->wi_val[0]);
1481: break;
1482: case WI_RID_NODENAME:
1483: error = wi_set_ssid(&sc->wi_node_name,
1484: (u_int8_t *)&wreq->wi_val[1], letoh16(wreq->wi_val[0]));
1485: break;
1486: case WI_RID_DESIRED_SSID:
1487: error = wi_set_ssid(&sc->wi_net_name,
1488: (u_int8_t *)&wreq->wi_val[1], letoh16(wreq->wi_val[0]));
1489: break;
1490: case WI_RID_OWN_SSID:
1491: error = wi_set_ssid(&sc->wi_ibss_name,
1492: (u_int8_t *)&wreq->wi_val[1], letoh16(wreq->wi_val[0]));
1493: break;
1494: case WI_RID_PM_ENABLED:
1495: sc->wi_pm_enabled = letoh16(wreq->wi_val[0]);
1496: break;
1497: case WI_RID_MICROWAVE_OVEN:
1498: sc->wi_mor_enabled = letoh16(wreq->wi_val[0]);
1499: break;
1500: case WI_RID_MAX_SLEEP:
1501: sc->wi_max_sleep = letoh16(wreq->wi_val[0]);
1502: break;
1503: case WI_RID_CNFAUTHMODE:
1504: sc->wi_authtype = letoh16(wreq->wi_val[0]);
1505: break;
1506: case WI_RID_ROAMING_MODE:
1507: sc->wi_roaming = letoh16(wreq->wi_val[0]);
1508: break;
1509: case WI_RID_SYMBOL_DIVERSITY:
1510: sc->wi_diversity = letoh16(wreq->wi_val[0]);
1511: break;
1512: case WI_RID_ENH_SECURITY:
1513: sc->wi_enh_security = letoh16(wreq->wi_val[0]);
1514: break;
1515: case WI_RID_ENCRYPTION:
1516: sc->wi_use_wep = letoh16(wreq->wi_val[0]);
1517: break;
1518: case WI_RID_TX_CRYPT_KEY:
1519: sc->wi_tx_key = letoh16(wreq->wi_val[0]);
1520: break;
1521: case WI_RID_DEFLT_CRYPT_KEYS:
1522: bcopy((char *)wreq, (char *)&sc->wi_keys,
1523: sizeof(struct wi_ltv_keys));
1524: break;
1525: case WI_FRID_CRYPTO_ALG:
1526: switch (letoh16(wreq->wi_val[0])) {
1527: case WI_CRYPTO_FIRMWARE_WEP:
1528: sc->wi_crypto_algorithm = WI_CRYPTO_FIRMWARE_WEP;
1529: break;
1530: case WI_CRYPTO_SOFTWARE_WEP:
1531: sc->wi_crypto_algorithm = WI_CRYPTO_SOFTWARE_WEP;
1532: break;
1533: default:
1534: printf(WI_PRT_FMT ": unsupported crypto algorithm %d\n",
1535: WI_PRT_ARG(sc), letoh16(wreq->wi_val[0]));
1536: error = EINVAL;
1537: }
1538: break;
1539: default:
1540: error = EINVAL;
1541: break;
1542: }
1543:
1544: return (error);
1545: }
1546:
1547: STATIC int
1548: wi_ioctl(struct ifnet *ifp, u_long command, caddr_t data)
1549: {
1550: int s, error = 0, i, j, len;
1551: struct wi_softc *sc;
1552: struct ifreq *ifr;
1553: struct proc *p = curproc;
1554: struct ifaddr *ifa = (struct ifaddr *)data;
1555: struct wi_scan_res *res;
1556: struct wi_scan_p2_hdr *p2;
1557: struct wi_req *wreq = NULL;
1558: u_int32_t flags;
1559:
1560: struct ieee80211_nwid *nwidp = NULL;
1561: struct ieee80211_nodereq_all *na;
1562: struct ieee80211_bssid *bssid;
1563:
1564: s = splnet();
1565:
1566: sc = ifp->if_softc;
1567: ifr = (struct ifreq *)data;
1568:
1569: if (!(sc->wi_flags & WI_FLAGS_ATTACHED)) {
1570: splx(s);
1571: return(ENODEV);
1572: }
1573:
1574: DPRINTF (WID_IOCTL, ("wi_ioctl: command %lu data %p\n",
1575: command, data));
1576:
1577: if ((error = ether_ioctl(ifp, &sc->sc_ic.ic_ac, command, data)) > 0) {
1578: splx(s);
1579: return error;
1580: }
1581:
1582: switch(command) {
1583: case SIOCSIFADDR:
1584: ifp->if_flags |= IFF_UP;
1585: switch (ifa->ifa_addr->sa_family) {
1586: #ifdef INET
1587: case AF_INET:
1588: wi_init(sc);
1589: arp_ifinit(&sc->sc_ic.ic_ac, ifa);
1590: break;
1591: #endif /* INET */
1592: default:
1593: wi_init(sc);
1594: break;
1595: }
1596: break;
1597:
1598: case SIOCSIFMTU:
1599: if (ifr->ifr_mtu > ETHERMTU || ifr->ifr_mtu < ETHERMIN) {
1600: error = EINVAL;
1601: } else if (ifp->if_mtu != ifr->ifr_mtu) {
1602: ifp->if_mtu = ifr->ifr_mtu;
1603: }
1604: break;
1605:
1606: case SIOCSIFFLAGS:
1607: if (ifp->if_flags & IFF_UP) {
1608: if (ifp->if_flags & IFF_RUNNING &&
1609: ifp->if_flags & IFF_PROMISC &&
1610: !(sc->wi_if_flags & IFF_PROMISC)) {
1611: if (sc->wi_ptype != WI_PORTTYPE_HOSTAP)
1612: WI_SETVAL(WI_RID_PROMISC, 1);
1613: } else if (ifp->if_flags & IFF_RUNNING &&
1614: !(ifp->if_flags & IFF_PROMISC) &&
1615: sc->wi_if_flags & IFF_PROMISC) {
1616: if (sc->wi_ptype != WI_PORTTYPE_HOSTAP)
1617: WI_SETVAL(WI_RID_PROMISC, 0);
1618: } else
1619: wi_init(sc);
1620: } else if (ifp->if_flags & IFF_RUNNING)
1621: wi_stop(sc);
1622: sc->wi_if_flags = ifp->if_flags;
1623: error = 0;
1624: break;
1625: case SIOCADDMULTI:
1626: case SIOCDELMULTI:
1627: /* Update our multicast list. */
1628: error = (command == SIOCADDMULTI) ?
1629: ether_addmulti(ifr, &sc->sc_ic.ic_ac) :
1630: ether_delmulti(ifr, &sc->sc_ic.ic_ac);
1631:
1632: if (error == ENETRESET) {
1633: /*
1634: * Multicast list has changed; set the hardware filter
1635: * accordingly.
1636: */
1637: if (ifp->if_flags & IFF_RUNNING)
1638: wi_setmulti(sc);
1639: error = 0;
1640: }
1641: break;
1642: case SIOCSIFMEDIA:
1643: case SIOCGIFMEDIA:
1644: error = ifmedia_ioctl(ifp, ifr, &sc->sc_media, command);
1645: break;
1646: case SIOCGWAVELAN:
1647: wreq = malloc(sizeof *wreq, M_DEVBUF, M_WAITOK);
1648: bzero(wreq, sizeof(*wreq));
1649: error = copyin(ifr->ifr_data, wreq, sizeof(*wreq));
1650: if (error)
1651: break;
1652: if (wreq->wi_len > WI_MAX_DATALEN) {
1653: error = EINVAL;
1654: break;
1655: }
1656: switch (wreq->wi_type) {
1657: case WI_RID_IFACE_STATS:
1658: /* XXX native byte order */
1659: bcopy((char *)&sc->wi_stats, (char *)&wreq->wi_val,
1660: sizeof(sc->wi_stats));
1661: wreq->wi_len = (sizeof(sc->wi_stats) / 2) + 1;
1662: break;
1663: case WI_RID_DEFLT_CRYPT_KEYS:
1664: /* For non-root user, return all-zeroes keys */
1665: if (suser(p, 0))
1666: bzero(wreq, sizeof(struct wi_ltv_keys));
1667: else
1668: bcopy((char *)&sc->wi_keys, wreq,
1669: sizeof(struct wi_ltv_keys));
1670: break;
1671: case WI_RID_PROCFRAME:
1672: wreq->wi_len = 2;
1673: wreq->wi_val[0] = htole16(sc->wi_procframe);
1674: break;
1675: case WI_RID_PRISM2:
1676: wreq->wi_len = 2;
1677: wreq->wi_val[0] = htole16(sc->sc_firmware_type ==
1678: WI_LUCENT ? 0 : 1);
1679: break;
1680: case WI_FRID_CRYPTO_ALG:
1681: wreq->wi_val[0] =
1682: htole16((u_int16_t)sc->wi_crypto_algorithm);
1683: wreq->wi_len = 1;
1684: break;
1685: case WI_RID_SCAN_RES:
1686: if (sc->sc_firmware_type == WI_LUCENT) {
1687: memcpy((char *)wreq->wi_val,
1688: (char *)sc->wi_scanbuf,
1689: sc->wi_scanbuf_len * 2);
1690: wreq->wi_len = sc->wi_scanbuf_len;
1691: break;
1692: }
1693: /* FALLTHROUGH */
1694: default:
1695: if (wi_read_record(sc, (struct wi_ltv_gen *)wreq)) {
1696: error = EINVAL;
1697: }
1698: break;
1699: }
1700: error = copyout(wreq, ifr->ifr_data, sizeof(*wreq));
1701: break;
1702: case SIOCSWAVELAN:
1703: if ((error = suser(curproc, 0)) != 0)
1704: break;
1705: wreq = malloc(sizeof *wreq, M_DEVBUF, M_WAITOK);
1706: bzero(wreq, sizeof(*wreq));
1707: error = copyin(ifr->ifr_data, wreq, sizeof(*wreq));
1708: if (error)
1709: break;
1710: error = EINVAL;
1711: if (wreq->wi_len > WI_MAX_DATALEN)
1712: break;
1713: switch (wreq->wi_type) {
1714: case WI_RID_IFACE_STATS:
1715: break;
1716: case WI_RID_MGMT_XMIT:
1717: error = wi_mgmt_xmit(sc, (caddr_t)&wreq->wi_val,
1718: wreq->wi_len);
1719: break;
1720: case WI_RID_PROCFRAME:
1721: sc->wi_procframe = letoh16(wreq->wi_val[0]);
1722: error = 0;
1723: break;
1724: case WI_RID_SCAN_REQ:
1725: error = 0;
1726: if (sc->sc_firmware_type == WI_LUCENT)
1727: wi_cmd(sc, WI_CMD_INQUIRE,
1728: WI_INFO_SCAN_RESULTS, 0, 0);
1729: else
1730: error = wi_write_record(sc,
1731: (struct wi_ltv_gen *)wreq);
1732: break;
1733: case WI_FRID_CRYPTO_ALG:
1734: if (sc->sc_firmware_type != WI_LUCENT) {
1735: error = wi_setdef(sc, wreq);
1736: if (!error && (ifp->if_flags & IFF_UP))
1737: wi_init(sc);
1738: }
1739: break;
1740: case WI_RID_SYMBOL_DIVERSITY:
1741: case WI_RID_ROAMING_MODE:
1742: case WI_RID_CREATE_IBSS:
1743: case WI_RID_MICROWAVE_OVEN:
1744: case WI_RID_OWN_SSID:
1745: case WI_RID_ENH_SECURITY:
1746: /*
1747: * Check for features that may not be supported
1748: * (must be just before default case).
1749: */
1750: if ((wreq->wi_type == WI_RID_SYMBOL_DIVERSITY &&
1751: !(sc->wi_flags & WI_FLAGS_HAS_DIVERSITY)) ||
1752: (wreq->wi_type == WI_RID_ROAMING_MODE &&
1753: !(sc->wi_flags & WI_FLAGS_HAS_ROAMING)) ||
1754: (wreq->wi_type == WI_RID_CREATE_IBSS &&
1755: !(sc->wi_flags & WI_FLAGS_HAS_CREATE_IBSS)) ||
1756: (wreq->wi_type == WI_RID_MICROWAVE_OVEN &&
1757: !(sc->wi_flags & WI_FLAGS_HAS_MOR)) ||
1758: (wreq->wi_type == WI_RID_ENH_SECURITY &&
1759: !(sc->wi_flags & WI_FLAGS_HAS_ENH_SECURITY)) ||
1760: (wreq->wi_type == WI_RID_OWN_SSID &&
1761: wreq->wi_len != 0))
1762: break;
1763: /* FALLTHROUGH */
1764: default:
1765: error = wi_write_record(sc, (struct wi_ltv_gen *)wreq);
1766: if (!error)
1767: error = wi_setdef(sc, wreq);
1768: if (!error && (ifp->if_flags & IFF_UP))
1769: wi_init(sc);
1770: }
1771: break;
1772: case SIOCGPRISM2DEBUG:
1773: wreq = malloc(sizeof *wreq, M_DEVBUF, M_WAITOK);
1774: bzero(wreq, sizeof(*wreq));
1775: error = copyin(ifr->ifr_data, wreq, sizeof(*wreq));
1776: if (error)
1777: break;
1778: if (!(ifp->if_flags & IFF_RUNNING) ||
1779: sc->sc_firmware_type == WI_LUCENT) {
1780: error = EIO;
1781: break;
1782: }
1783: error = wi_get_debug(sc, wreq);
1784: if (error == 0)
1785: error = copyout(wreq, ifr->ifr_data, sizeof(*wreq));
1786: break;
1787: case SIOCSPRISM2DEBUG:
1788: if ((error = suser(curproc, 0)) != 0)
1789: break;
1790: wreq = malloc(sizeof *wreq, M_DEVBUF, M_WAITOK);
1791: bzero(wreq, sizeof(*wreq));
1792: error = copyin(ifr->ifr_data, wreq, sizeof(*wreq));
1793: if (error)
1794: break;
1795: error = wi_set_debug(sc, wreq);
1796: break;
1797: case SIOCG80211NWID:
1798: if ((ifp->if_flags & IFF_UP) && sc->wi_net_name.i_len > 0) {
1799: /* Return the desired ID */
1800: error = copyout(&sc->wi_net_name, ifr->ifr_data,
1801: sizeof(sc->wi_net_name));
1802: } else {
1803: wreq = malloc(sizeof *wreq, M_DEVBUF, M_WAITOK);
1804: bzero(wreq, sizeof(*wreq));
1805: wreq->wi_type = WI_RID_CURRENT_SSID;
1806: wreq->wi_len = WI_MAX_DATALEN;
1807: if (wi_read_record(sc, (struct wi_ltv_gen *)wreq) ||
1808: letoh16(wreq->wi_val[0]) > IEEE80211_NWID_LEN)
1809: error = EINVAL;
1810: else {
1811: nwidp = malloc(sizeof *nwidp, M_DEVBUF, M_WAITOK);
1812: bzero(nwidp, sizeof(*nwidp));
1813: wi_set_ssid(nwidp, (u_int8_t *)&wreq->wi_val[1],
1814: letoh16(wreq->wi_val[0]));
1815: error = copyout(nwidp, ifr->ifr_data,
1816: sizeof(*nwidp));
1817: }
1818: }
1819: break;
1820: case SIOCS80211NWID:
1821: if ((error = suser(curproc, 0)) != 0)
1822: break;
1823: nwidp = malloc(sizeof *nwidp, M_DEVBUF, M_WAITOK);
1824: error = copyin(ifr->ifr_data, nwidp, sizeof(*nwidp));
1825: if (error)
1826: break;
1827: if (nwidp->i_len > IEEE80211_NWID_LEN) {
1828: error = EINVAL;
1829: break;
1830: }
1831: if (sc->wi_net_name.i_len == nwidp->i_len &&
1832: memcmp(sc->wi_net_name.i_nwid, nwidp->i_nwid, nwidp->i_len) == 0)
1833: break;
1834: wi_set_ssid(&sc->wi_net_name, nwidp->i_nwid, nwidp->i_len);
1835: WI_SETSTR(WI_RID_DESIRED_SSID, sc->wi_net_name);
1836: if (ifp->if_flags & IFF_UP)
1837: /* Reinitialize WaveLAN. */
1838: wi_init(sc);
1839: break;
1840: case SIOCS80211NWKEY:
1841: if ((error = suser(curproc, 0)) != 0)
1842: break;
1843: error = wi_set_nwkey(sc, (struct ieee80211_nwkey *)data);
1844: break;
1845: case SIOCG80211NWKEY:
1846: error = wi_get_nwkey(sc, (struct ieee80211_nwkey *)data);
1847: break;
1848: case SIOCS80211POWER:
1849: if ((error = suser(curproc, 0)) != 0)
1850: break;
1851: error = wi_set_pm(sc, (struct ieee80211_power *)data);
1852: break;
1853: case SIOCG80211POWER:
1854: error = wi_get_pm(sc, (struct ieee80211_power *)data);
1855: break;
1856: case SIOCS80211TXPOWER:
1857: if ((error = suser(curproc, 0)) != 0)
1858: break;
1859: error = wi_set_txpower(sc, (struct ieee80211_txpower *)data);
1860: break;
1861: case SIOCG80211TXPOWER:
1862: error = wi_get_txpower(sc, (struct ieee80211_txpower *)data);
1863: break;
1864: case SIOCS80211CHANNEL:
1865: if ((error = suser(curproc, 0)) != 0)
1866: break;
1867: if (((struct ieee80211chanreq *)data)->i_channel > 14) {
1868: error = EINVAL;
1869: break;
1870: }
1871: wreq = malloc(sizeof *wreq, M_DEVBUF, M_WAITOK);
1872: bzero(wreq, sizeof(*wreq));
1873: wreq->wi_type = WI_RID_OWN_CHNL;
1874: wreq->wi_val[0] =
1875: htole16(((struct ieee80211chanreq *)data)->i_channel);
1876: error = wi_setdef(sc, wreq);
1877: if (!error && (ifp->if_flags & IFF_UP))
1878: wi_init(sc);
1879: break;
1880: case SIOCG80211CHANNEL:
1881: wreq = malloc(sizeof *wreq, M_DEVBUF, M_WAITOK);
1882: bzero(wreq, sizeof(*wreq));
1883: wreq->wi_type = WI_RID_CURRENT_CHAN;
1884: wreq->wi_len = WI_MAX_DATALEN;
1885: if (wi_read_record(sc, (struct wi_ltv_gen *)wreq)) {
1886: error = EINVAL;
1887: break;
1888: }
1889: ((struct ieee80211chanreq *)data)->i_channel =
1890: letoh16(wreq->wi_val[0]);
1891: break;
1892: case SIOCG80211BSSID:
1893: bssid = (struct ieee80211_bssid *)data;
1894: wreq = malloc(sizeof *wreq, M_DEVBUF, M_WAITOK);
1895: bzero(wreq, sizeof(*wreq));
1896: wreq->wi_type = WI_RID_CURRENT_BSSID;
1897: wreq->wi_len = WI_MAX_DATALEN;
1898: if (wi_read_record(sc, (struct wi_ltv_gen *)wreq)) {
1899: error = EINVAL;
1900: break;
1901: }
1902: IEEE80211_ADDR_COPY(bssid->i_bssid, wreq->wi_val);
1903: break;
1904: case SIOCS80211SCAN:
1905: if ((error = suser(curproc, 0)) != 0)
1906: break;
1907: if (sc->wi_ptype == WI_PORTTYPE_HOSTAP)
1908: break;
1909: if ((ifp->if_flags & IFF_UP) == 0) {
1910: error = ENETDOWN;
1911: break;
1912: }
1913: if (sc->sc_firmware_type == WI_LUCENT) {
1914: wi_cmd(sc, WI_CMD_INQUIRE,
1915: WI_INFO_SCAN_RESULTS, 0, 0);
1916: } else {
1917: wreq = malloc(sizeof *wreq, M_DEVBUF, M_WAITOK);
1918: bzero(wreq, sizeof(*wreq));
1919: wreq->wi_len = 3;
1920: wreq->wi_type = WI_RID_SCAN_REQ;
1921: wreq->wi_val[0] = 0x3FFF;
1922: wreq->wi_val[1] = 0x000F;
1923:
1924: error = wi_write_record(sc,
1925: (struct wi_ltv_gen *)wreq);
1926: if (error)
1927: break;
1928: }
1929: sc->wi_scan_lock = 0;
1930: timeout_set(&sc->wi_scan_timeout, wi_scan_timeout, sc);
1931: len = WI_WAVELAN_RES_TIMEOUT;
1932: if (sc->wi_flags & WI_FLAGS_BUS_USB) {
1933: /* Use a longer timeout for wi@usb */
1934: len = WI_WAVELAN_RES_TIMEOUT * 4;
1935: }
1936: timeout_add(&sc->wi_scan_timeout, len);
1937:
1938: /* Let the userspace process wait for completion */
1939: error = tsleep(&sc->wi_scan_lock, PCATCH, "wiscan",
1940: hz * IEEE80211_SCAN_TIMEOUT);
1941: break;
1942: case SIOCG80211ALLNODES:
1943: {
1944: struct ieee80211_nodereq *nr = NULL;
1945:
1946: if ((error = suser(curproc, 0)) != 0)
1947: break;
1948: na = (struct ieee80211_nodereq_all *)data;
1949: if (sc->wi_ptype == WI_PORTTYPE_HOSTAP) {
1950: /* List all associated stations */
1951: error = wihap_ioctl(sc, command, data);
1952: break;
1953: }
1954: wreq = malloc(sizeof *wreq, M_DEVBUF, M_WAITOK);
1955: bzero(wreq, sizeof(*wreq));
1956: wreq->wi_len = WI_MAX_DATALEN;
1957: wreq->wi_type = WI_RID_SCAN_RES;
1958: if (sc->sc_firmware_type == WI_LUCENT) {
1959: bcopy(sc->wi_scanbuf, wreq->wi_val,
1960: sc->wi_scanbuf_len * 2);
1961: wreq->wi_len = sc->wi_scanbuf_len;
1962: i = 0;
1963: len = WI_WAVELAN_RES_SIZE;
1964: } else {
1965: if (wi_read_record(sc, (struct wi_ltv_gen *)wreq)) {
1966: error = EINVAL;
1967: break;
1968: }
1969: p2 = (struct wi_scan_p2_hdr *)wreq->wi_val;
1970: if (p2->wi_reason == 0)
1971: break;
1972: i = sizeof(*p2);
1973: len = WI_PRISM2_RES_SIZE;
1974: }
1975:
1976: for (na->na_nodes = j = 0; (i < (wreq->wi_len * 2) - len) &&
1977: (na->na_size >= j + sizeof(struct ieee80211_nodereq));
1978: i += len) {
1979:
1980: if (nr == NULL)
1981: nr = malloc(sizeof *nr, M_DEVBUF, M_WAITOK);
1982: res = (struct wi_scan_res *)((char *)wreq->wi_val + i);
1983: if (res == NULL)
1984: break;
1985:
1986: bzero(nr, sizeof(*nr));
1987: IEEE80211_ADDR_COPY(nr->nr_macaddr, res->wi_bssid);
1988: IEEE80211_ADDR_COPY(nr->nr_bssid, res->wi_bssid);
1989: nr->nr_channel = letoh16(res->wi_chan);
1990: nr->nr_chan_flags = IEEE80211_CHAN_B;
1991: nr->nr_rssi = letoh16(res->wi_signal);
1992: nr->nr_max_rssi = 0; /* XXX */
1993: nr->nr_nwid_len = letoh16(res->wi_ssid_len);
1994: bcopy(res->wi_ssid, nr->nr_nwid, nr->nr_nwid_len);
1995: nr->nr_intval = letoh16(res->wi_interval);
1996: nr->nr_capinfo = letoh16(res->wi_capinfo);
1997: nr->nr_txrate = res->wi_rate == WI_WAVELAN_RES_1M ? 2 :
1998: (res->wi_rate == WI_WAVELAN_RES_2M ? 4 :
1999: (res->wi_rate == WI_WAVELAN_RES_5M ? 11 :
2000: (res->wi_rate == WI_WAVELAN_RES_11M ? 22 : 0)));
2001: nr->nr_nrates = 0;
2002: while (res->wi_srates[nr->nr_nrates] != 0) {
2003: nr->nr_rates[nr->nr_nrates] =
2004: res->wi_srates[nr->nr_nrates] &
2005: WI_VAR_SRATES_MASK;
2006: nr->nr_nrates++;
2007: }
2008: nr->nr_flags = 0;
2009: if (bcmp(nr->nr_macaddr, nr->nr_bssid,
2010: IEEE80211_ADDR_LEN) == 0)
2011: nr->nr_flags |= IEEE80211_NODEREQ_AP;
2012:
2013: error = copyout(nr, (caddr_t)na->na_node + j,
2014: sizeof(struct ieee80211_nodereq));
2015: if (error)
2016: break;
2017: j += sizeof(struct ieee80211_nodereq);
2018: na->na_nodes++;
2019: }
2020: if (nr)
2021: free(nr, M_DEVBUF);
2022: break;
2023: }
2024: case SIOCG80211FLAGS:
2025: if (sc->wi_ptype != WI_PORTTYPE_HOSTAP)
2026: break;
2027: ifr->ifr_flags = 0;
2028: if (sc->wi_flags & WI_FLAGS_HAS_ENH_SECURITY) {
2029: wreq = malloc(sizeof *wreq, M_DEVBUF, M_WAITOK);
2030: bzero(wreq, sizeof(*wreq));
2031: wreq->wi_len = WI_MAX_DATALEN;
2032: wreq->wi_type = WI_RID_ENH_SECURITY;
2033: if (wi_read_record(sc, (struct wi_ltv_gen *)wreq)) {
2034: error = EINVAL;
2035: break;
2036: }
2037: sc->wi_enh_security = letoh16(wreq->wi_val[0]);
2038: if (sc->wi_enh_security == WI_HIDESSID_IGNPROBES)
2039: ifr->ifr_flags |= IEEE80211_F_HIDENWID >>
2040: IEEE80211_F_USERSHIFT;
2041: }
2042: break;
2043: case SIOCS80211FLAGS:
2044: if ((error = suser(curproc, 0)) != 0)
2045: break;
2046: if (sc->wi_ptype != WI_PORTTYPE_HOSTAP) {
2047: error = EINVAL;
2048: break;
2049: }
2050: flags = (u_int32_t)ifr->ifr_flags << IEEE80211_F_USERSHIFT;
2051: if (sc->wi_flags & WI_FLAGS_HAS_ENH_SECURITY) {
2052: sc->wi_enh_security = (flags & IEEE80211_F_HIDENWID) ?
2053: WI_HIDESSID_IGNPROBES : 0;
2054: WI_SETVAL(WI_RID_ENH_SECURITY, sc->wi_enh_security);
2055: }
2056: break;
2057: case SIOCHOSTAP_ADD:
2058: case SIOCHOSTAP_DEL:
2059: case SIOCHOSTAP_GET:
2060: case SIOCHOSTAP_GETALL:
2061: case SIOCHOSTAP_GFLAGS:
2062: case SIOCHOSTAP_SFLAGS:
2063: /* Send all Host AP specific ioctl's to Host AP code. */
2064: error = wihap_ioctl(sc, command, data);
2065: break;
2066: default:
2067: error = EINVAL;
2068: break;
2069: }
2070:
2071: if (wreq)
2072: free(wreq, M_DEVBUF);
2073: if (nwidp)
2074: free(nwidp, M_DEVBUF);
2075: splx(s);
2076: return(error);
2077: }
2078:
2079: void
2080: wi_scan_timeout(void *arg)
2081: {
2082: struct wi_softc *sc = (struct wi_softc *)arg;
2083: struct wi_req wreq;
2084:
2085: if (sc->wi_scan_lock++ < WI_WAVELAN_RES_TRIES &&
2086: sc->sc_firmware_type != WI_LUCENT &&
2087: (sc->wi_flags & WI_FLAGS_BUS_USB) == 0) {
2088: /*
2089: * The Prism2/2.5/3 chipsets will set an extra field in the
2090: * scan result if the scan request has been completed by the
2091: * firmware. This allows to poll for completion and to
2092: * wait for some more time if the scan is still in progress.
2093: *
2094: * XXX This doesn't work with wi@usb because it isn't safe
2095: * to call wi_read_record_usb() while beeing in the timeout
2096: * handler.
2097: */
2098: wreq.wi_len = WI_MAX_DATALEN;
2099: wreq.wi_type = WI_RID_SCAN_RES;
2100:
2101: if (wi_read_record(sc, (struct wi_ltv_gen *)&wreq) == 0 &&
2102: ((struct wi_scan_p2_hdr *)wreq.wi_val)->wi_reason == 0) {
2103: /* Wait some more time for scan completion */
2104: timeout_add(&sc->wi_scan_timeout, WI_WAVELAN_RES_TIMEOUT);
2105: return;
2106: }
2107: }
2108:
2109: if (sc->sc_ic.ic_if.if_flags & IFF_DEBUG)
2110: printf(WI_PRT_FMT ": wi_scan_timeout: %d tries\n",
2111: WI_PRT_ARG(sc), sc->wi_scan_lock);
2112:
2113: /* Wakeup the userland */
2114: wakeup(&sc->wi_scan_lock);
2115: sc->wi_scan_lock = 0;
2116: }
2117:
2118: STATIC void
2119: wi_init_io(struct wi_softc *sc)
2120: {
2121: struct ifnet *ifp = &sc->sc_ic.ic_ac.ac_if;
2122: int s;
2123: struct wi_ltv_macaddr mac;
2124: int id = 0;
2125:
2126: if (!(sc->wi_flags & WI_FLAGS_ATTACHED))
2127: return;
2128:
2129: DPRINTF(WID_INIT, ("wi_init: sc %p\n", sc));
2130:
2131: s = splnet();
2132:
2133: if (ifp->if_flags & IFF_RUNNING)
2134: wi_stop(sc);
2135:
2136: wi_reset(sc);
2137:
2138: /* Program max data length. */
2139: WI_SETVAL(WI_RID_MAX_DATALEN, sc->wi_max_data_len);
2140:
2141: /* Set the port type. */
2142: WI_SETVAL(WI_RID_PORTTYPE, sc->wi_ptype);
2143:
2144: /* Enable/disable IBSS creation. */
2145: WI_SETVAL(WI_RID_CREATE_IBSS, sc->wi_create_ibss);
2146:
2147: /* Program the RTS/CTS threshold. */
2148: WI_SETVAL(WI_RID_RTS_THRESH, sc->wi_rts_thresh);
2149:
2150: /* Program the TX rate */
2151: WI_SETVAL(WI_RID_TX_RATE, sc->wi_tx_rate);
2152:
2153: /* Access point density */
2154: WI_SETVAL(WI_RID_SYSTEM_SCALE, sc->wi_ap_density);
2155:
2156: /* Power Management Enabled */
2157: WI_SETVAL(WI_RID_PM_ENABLED, sc->wi_pm_enabled);
2158:
2159: /* Power Management Max Sleep */
2160: WI_SETVAL(WI_RID_MAX_SLEEP, sc->wi_max_sleep);
2161:
2162: /* Set Enhanced Security if supported. */
2163: if (sc->wi_flags & WI_FLAGS_HAS_ENH_SECURITY)
2164: WI_SETVAL(WI_RID_ENH_SECURITY, sc->wi_enh_security);
2165:
2166: /* Set Roaming Mode unless this is a Symbol card. */
2167: if (sc->wi_flags & WI_FLAGS_HAS_ROAMING)
2168: WI_SETVAL(WI_RID_ROAMING_MODE, sc->wi_roaming);
2169:
2170: /* Set Antenna Diversity if this is a Symbol card. */
2171: if (sc->wi_flags & WI_FLAGS_HAS_DIVERSITY)
2172: WI_SETVAL(WI_RID_SYMBOL_DIVERSITY, sc->wi_diversity);
2173:
2174: /* Specify the network name */
2175: WI_SETSTR(WI_RID_DESIRED_SSID, sc->wi_net_name);
2176:
2177: /* Specify the IBSS name */
2178: if (sc->wi_net_name.i_len != 0 && (sc->wi_ptype == WI_PORTTYPE_HOSTAP ||
2179: (sc->wi_create_ibss && sc->wi_ptype == WI_PORTTYPE_IBSS)))
2180: WI_SETSTR(WI_RID_OWN_SSID, sc->wi_net_name);
2181: else
2182: WI_SETSTR(WI_RID_OWN_SSID, sc->wi_ibss_name);
2183:
2184: /* Specify the frequency to use */
2185: WI_SETVAL(WI_RID_OWN_CHNL, sc->wi_channel);
2186:
2187: /* Program the nodename. */
2188: WI_SETSTR(WI_RID_NODENAME, sc->wi_node_name);
2189:
2190: /* Set our MAC address. */
2191: mac.wi_len = 4;
2192: mac.wi_type = WI_RID_MAC_NODE;
2193: bcopy(LLADDR(ifp->if_sadl),
2194: (char *)&sc->sc_ic.ic_myaddr, ETHER_ADDR_LEN);
2195: bcopy((char *)&sc->sc_ic.ic_myaddr,
2196: (char *)&mac.wi_mac_addr, ETHER_ADDR_LEN);
2197: wi_write_record(sc, (struct wi_ltv_gen *)&mac);
2198:
2199: /*
2200: * Initialize promisc mode.
2201: * Being in the Host-AP mode causes
2202: * great deal of pain if promisc mode is set.
2203: * Therefore we avoid confusing the firmware
2204: * and always reset promisc mode in Host-AP regime,
2205: * it shows us all the packets anyway.
2206: */
2207: if (sc->wi_ptype != WI_PORTTYPE_HOSTAP && ifp->if_flags & IFF_PROMISC)
2208: WI_SETVAL(WI_RID_PROMISC, 1);
2209: else
2210: WI_SETVAL(WI_RID_PROMISC, 0);
2211:
2212: /* Configure WEP. */
2213: if (sc->wi_flags & WI_FLAGS_HAS_WEP) {
2214: WI_SETVAL(WI_RID_ENCRYPTION, sc->wi_use_wep);
2215: WI_SETVAL(WI_RID_TX_CRYPT_KEY, sc->wi_tx_key);
2216: sc->wi_keys.wi_len = (sizeof(struct wi_ltv_keys) / 2) + 1;
2217: sc->wi_keys.wi_type = WI_RID_DEFLT_CRYPT_KEYS;
2218: wi_write_record(sc, (struct wi_ltv_gen *)&sc->wi_keys);
2219: if (sc->sc_firmware_type != WI_LUCENT && sc->wi_use_wep) {
2220: /*
2221: * HWB3163 EVAL-CARD Firmware version less than 0.8.2.
2222: *
2223: * If promiscuous mode is disabled, the Prism2 chip
2224: * does not work with WEP .
2225: * I'm currently investigating the details of this.
2226: * (ichiro@netbsd.org)
2227: */
2228: if (sc->sc_firmware_type == WI_INTERSIL &&
2229: sc->sc_sta_firmware_ver < 802 ) {
2230: /* firm ver < 0.8.2 */
2231: WI_SETVAL(WI_RID_PROMISC, 1);
2232: }
2233: WI_SETVAL(WI_RID_CNFAUTHMODE, sc->wi_authtype);
2234: }
2235: }
2236:
2237: /* Set multicast filter. */
2238: wi_setmulti(sc);
2239:
2240: /* Enable desired port */
2241: wi_cmd(sc, WI_CMD_ENABLE | sc->wi_portnum, 0, 0, 0);
2242:
2243: if (wi_alloc_nicmem(sc, ETHER_MAX_LEN + sizeof(struct wi_frame) + 8, &id))
2244: printf(WI_PRT_FMT ": tx buffer allocation failed\n",
2245: WI_PRT_ARG(sc));
2246: sc->wi_tx_data_id = id;
2247:
2248: if (wi_alloc_nicmem(sc, ETHER_MAX_LEN + sizeof(struct wi_frame) + 8, &id))
2249: printf(WI_PRT_FMT ": mgmt. buffer allocation failed\n",
2250: WI_PRT_ARG(sc));
2251: sc->wi_tx_mgmt_id = id;
2252:
2253: /* Set txpower */
2254: if (sc->wi_flags & WI_FLAGS_TXPOWER)
2255: wi_set_txpower(sc, NULL);
2256:
2257: /* enable interrupts */
2258: wi_intr_enable(sc, WI_INTRS);
2259:
2260: wihap_init(sc);
2261:
2262: splx(s);
2263:
2264: ifp->if_flags |= IFF_RUNNING;
2265: ifp->if_flags &= ~IFF_OACTIVE;
2266:
2267: timeout_add(&sc->sc_timo, hz * 60);
2268:
2269: return;
2270: }
2271:
2272: static const u_int32_t crc32tab[] = {
2273: 0x00000000L, 0x77073096L, 0xee0e612cL, 0x990951baL,
2274: 0x076dc419L, 0x706af48fL, 0xe963a535L, 0x9e6495a3L,
2275: 0x0edb8832L, 0x79dcb8a4L, 0xe0d5e91eL, 0x97d2d988L,
2276: 0x09b64c2bL, 0x7eb17cbdL, 0xe7b82d07L, 0x90bf1d91L,
2277: 0x1db71064L, 0x6ab020f2L, 0xf3b97148L, 0x84be41deL,
2278: 0x1adad47dL, 0x6ddde4ebL, 0xf4d4b551L, 0x83d385c7L,
2279: 0x136c9856L, 0x646ba8c0L, 0xfd62f97aL, 0x8a65c9ecL,
2280: 0x14015c4fL, 0x63066cd9L, 0xfa0f3d63L, 0x8d080df5L,
2281: 0x3b6e20c8L, 0x4c69105eL, 0xd56041e4L, 0xa2677172L,
2282: 0x3c03e4d1L, 0x4b04d447L, 0xd20d85fdL, 0xa50ab56bL,
2283: 0x35b5a8faL, 0x42b2986cL, 0xdbbbc9d6L, 0xacbcf940L,
2284: 0x32d86ce3L, 0x45df5c75L, 0xdcd60dcfL, 0xabd13d59L,
2285: 0x26d930acL, 0x51de003aL, 0xc8d75180L, 0xbfd06116L,
2286: 0x21b4f4b5L, 0x56b3c423L, 0xcfba9599L, 0xb8bda50fL,
2287: 0x2802b89eL, 0x5f058808L, 0xc60cd9b2L, 0xb10be924L,
2288: 0x2f6f7c87L, 0x58684c11L, 0xc1611dabL, 0xb6662d3dL,
2289: 0x76dc4190L, 0x01db7106L, 0x98d220bcL, 0xefd5102aL,
2290: 0x71b18589L, 0x06b6b51fL, 0x9fbfe4a5L, 0xe8b8d433L,
2291: 0x7807c9a2L, 0x0f00f934L, 0x9609a88eL, 0xe10e9818L,
2292: 0x7f6a0dbbL, 0x086d3d2dL, 0x91646c97L, 0xe6635c01L,
2293: 0x6b6b51f4L, 0x1c6c6162L, 0x856530d8L, 0xf262004eL,
2294: 0x6c0695edL, 0x1b01a57bL, 0x8208f4c1L, 0xf50fc457L,
2295: 0x65b0d9c6L, 0x12b7e950L, 0x8bbeb8eaL, 0xfcb9887cL,
2296: 0x62dd1ddfL, 0x15da2d49L, 0x8cd37cf3L, 0xfbd44c65L,
2297: 0x4db26158L, 0x3ab551ceL, 0xa3bc0074L, 0xd4bb30e2L,
2298: 0x4adfa541L, 0x3dd895d7L, 0xa4d1c46dL, 0xd3d6f4fbL,
2299: 0x4369e96aL, 0x346ed9fcL, 0xad678846L, 0xda60b8d0L,
2300: 0x44042d73L, 0x33031de5L, 0xaa0a4c5fL, 0xdd0d7cc9L,
2301: 0x5005713cL, 0x270241aaL, 0xbe0b1010L, 0xc90c2086L,
2302: 0x5768b525L, 0x206f85b3L, 0xb966d409L, 0xce61e49fL,
2303: 0x5edef90eL, 0x29d9c998L, 0xb0d09822L, 0xc7d7a8b4L,
2304: 0x59b33d17L, 0x2eb40d81L, 0xb7bd5c3bL, 0xc0ba6cadL,
2305: 0xedb88320L, 0x9abfb3b6L, 0x03b6e20cL, 0x74b1d29aL,
2306: 0xead54739L, 0x9dd277afL, 0x04db2615L, 0x73dc1683L,
2307: 0xe3630b12L, 0x94643b84L, 0x0d6d6a3eL, 0x7a6a5aa8L,
2308: 0xe40ecf0bL, 0x9309ff9dL, 0x0a00ae27L, 0x7d079eb1L,
2309: 0xf00f9344L, 0x8708a3d2L, 0x1e01f268L, 0x6906c2feL,
2310: 0xf762575dL, 0x806567cbL, 0x196c3671L, 0x6e6b06e7L,
2311: 0xfed41b76L, 0x89d32be0L, 0x10da7a5aL, 0x67dd4accL,
2312: 0xf9b9df6fL, 0x8ebeeff9L, 0x17b7be43L, 0x60b08ed5L,
2313: 0xd6d6a3e8L, 0xa1d1937eL, 0x38d8c2c4L, 0x4fdff252L,
2314: 0xd1bb67f1L, 0xa6bc5767L, 0x3fb506ddL, 0x48b2364bL,
2315: 0xd80d2bdaL, 0xaf0a1b4cL, 0x36034af6L, 0x41047a60L,
2316: 0xdf60efc3L, 0xa867df55L, 0x316e8eefL, 0x4669be79L,
2317: 0xcb61b38cL, 0xbc66831aL, 0x256fd2a0L, 0x5268e236L,
2318: 0xcc0c7795L, 0xbb0b4703L, 0x220216b9L, 0x5505262fL,
2319: 0xc5ba3bbeL, 0xb2bd0b28L, 0x2bb45a92L, 0x5cb36a04L,
2320: 0xc2d7ffa7L, 0xb5d0cf31L, 0x2cd99e8bL, 0x5bdeae1dL,
2321: 0x9b64c2b0L, 0xec63f226L, 0x756aa39cL, 0x026d930aL,
2322: 0x9c0906a9L, 0xeb0e363fL, 0x72076785L, 0x05005713L,
2323: 0x95bf4a82L, 0xe2b87a14L, 0x7bb12baeL, 0x0cb61b38L,
2324: 0x92d28e9bL, 0xe5d5be0dL, 0x7cdcefb7L, 0x0bdbdf21L,
2325: 0x86d3d2d4L, 0xf1d4e242L, 0x68ddb3f8L, 0x1fda836eL,
2326: 0x81be16cdL, 0xf6b9265bL, 0x6fb077e1L, 0x18b74777L,
2327: 0x88085ae6L, 0xff0f6a70L, 0x66063bcaL, 0x11010b5cL,
2328: 0x8f659effL, 0xf862ae69L, 0x616bffd3L, 0x166ccf45L,
2329: 0xa00ae278L, 0xd70dd2eeL, 0x4e048354L, 0x3903b3c2L,
2330: 0xa7672661L, 0xd06016f7L, 0x4969474dL, 0x3e6e77dbL,
2331: 0xaed16a4aL, 0xd9d65adcL, 0x40df0b66L, 0x37d83bf0L,
2332: 0xa9bcae53L, 0xdebb9ec5L, 0x47b2cf7fL, 0x30b5ffe9L,
2333: 0xbdbdf21cL, 0xcabac28aL, 0x53b39330L, 0x24b4a3a6L,
2334: 0xbad03605L, 0xcdd70693L, 0x54de5729L, 0x23d967bfL,
2335: 0xb3667a2eL, 0xc4614ab8L, 0x5d681b02L, 0x2a6f2b94L,
2336: 0xb40bbe37L, 0xc30c8ea1L, 0x5a05df1bL, 0x2d02ef8dL
2337: };
2338:
2339: STATIC void
2340: wi_do_hostencrypt(struct wi_softc *sc, caddr_t buf, int len)
2341: {
2342: u_int32_t i, crc, klen;
2343: u_int8_t key[RC4KEYLEN];
2344: u_int8_t *dat;
2345: struct rc4_ctx ctx;
2346:
2347: if (!sc->wi_icv_flag) {
2348: sc->wi_icv = arc4random();
2349: sc->wi_icv_flag++;
2350: } else
2351: sc->wi_icv++;
2352: /*
2353: * Skip 'bad' IVs from Fluhrer/Mantin/Shamir:
2354: * (B, 255, N) with 3 <= B < 8
2355: */
2356: if (sc->wi_icv >= 0x03ff00 &&
2357: (sc->wi_icv & 0xf8ff00) == 0x00ff00)
2358: sc->wi_icv += 0x000100;
2359:
2360: /* prepend 24bit IV to tx key, byte order does not matter */
2361: bzero(key, sizeof(key));
2362: key[0] = sc->wi_icv >> 16;
2363: key[1] = sc->wi_icv >> 8;
2364: key[2] = sc->wi_icv;
2365:
2366: klen = letoh16(sc->wi_keys.wi_keys[sc->wi_tx_key].wi_keylen);
2367: bcopy((char *)&sc->wi_keys.wi_keys[sc->wi_tx_key].wi_keydat,
2368: (char *)key + IEEE80211_WEP_IVLEN, klen);
2369: klen = (klen > IEEE80211_WEP_KEYLEN) ? RC4KEYLEN : RC4KEYLEN / 2;
2370:
2371: /* rc4 keysetup */
2372: rc4_keysetup(&ctx, key, klen);
2373:
2374: /* output: IV, tx keyid, rc4(data), rc4(crc32(data)) */
2375: dat = buf;
2376: dat[0] = key[0];
2377: dat[1] = key[1];
2378: dat[2] = key[2];
2379: dat[3] = sc->wi_tx_key << 6; /* pad and keyid */
2380: dat += 4;
2381:
2382: /* compute crc32 over data and encrypt */
2383: crc = ~0;
2384: for (i = 0; i < len; i++)
2385: crc = crc32tab[(crc ^ dat[i]) & 0xff] ^ (crc >> 8);
2386: crc = ~crc;
2387: rc4_crypt(&ctx, dat, dat, len);
2388: dat += len;
2389:
2390: /* append little-endian crc32 and encrypt */
2391: dat[0] = crc;
2392: dat[1] = crc >> 8;
2393: dat[2] = crc >> 16;
2394: dat[3] = crc >> 24;
2395: rc4_crypt(&ctx, dat, dat, IEEE80211_WEP_CRCLEN);
2396: }
2397:
2398: STATIC int
2399: wi_do_hostdecrypt(struct wi_softc *sc, caddr_t buf, int len)
2400: {
2401: u_int32_t i, crc, klen, kid;
2402: u_int8_t key[RC4KEYLEN];
2403: u_int8_t *dat;
2404: struct rc4_ctx ctx;
2405:
2406: if (len < IEEE80211_WEP_IVLEN + IEEE80211_WEP_KIDLEN +
2407: IEEE80211_WEP_CRCLEN)
2408: return -1;
2409: len -= (IEEE80211_WEP_IVLEN + IEEE80211_WEP_KIDLEN +
2410: IEEE80211_WEP_CRCLEN);
2411:
2412: dat = buf;
2413:
2414: bzero(key, sizeof(key));
2415: key[0] = dat[0];
2416: key[1] = dat[1];
2417: key[2] = dat[2];
2418: kid = (dat[3] >> 6) % 4;
2419: dat += 4;
2420:
2421: klen = letoh16(sc->wi_keys.wi_keys[kid].wi_keylen);
2422: bcopy((char *)&sc->wi_keys.wi_keys[kid].wi_keydat,
2423: (char *)key + IEEE80211_WEP_IVLEN, klen);
2424: klen = (klen > IEEE80211_WEP_KEYLEN) ? RC4KEYLEN : RC4KEYLEN / 2;
2425:
2426: /* rc4 keysetup */
2427: rc4_keysetup(&ctx, key, klen);
2428:
2429: /* decrypt and compute crc32 over data */
2430: rc4_crypt(&ctx, dat, dat, len);
2431: crc = ~0;
2432: for (i = 0; i < len; i++)
2433: crc = crc32tab[(crc ^ dat[i]) & 0xff] ^ (crc >> 8);
2434: crc = ~crc;
2435: dat += len;
2436:
2437: /* decrypt little-endian crc32 and verify */
2438: rc4_crypt(&ctx, dat, dat, IEEE80211_WEP_CRCLEN);
2439:
2440: if ((dat[0] != crc) && (dat[1] != crc >> 8) &&
2441: (dat[2] != crc >> 16) && (dat[3] != crc >> 24)) {
2442: if (sc->sc_ic.ic_if.if_flags & IFF_DEBUG)
2443: printf(WI_PRT_FMT ": wi_do_hostdecrypt: iv mismatch: "
2444: "0x%02x%02x%02x%02x vs. 0x%x\n", WI_PRT_ARG(sc),
2445: dat[3], dat[2], dat[1], dat[0], crc);
2446: return -1;
2447: }
2448:
2449: return 0;
2450: }
2451:
2452: void
2453: wi_start(struct ifnet *ifp)
2454: {
2455: struct wi_softc *sc;
2456: struct mbuf *m0;
2457: struct wi_frame tx_frame;
2458: struct ether_header *eh;
2459: int id, hostencrypt = 0;
2460:
2461: sc = ifp->if_softc;
2462:
2463: DPRINTF(WID_START, ("wi_start: ifp %p sc %p\n", ifp, sc));
2464:
2465: if (!(sc->wi_flags & WI_FLAGS_ATTACHED))
2466: return;
2467:
2468: if (ifp->if_flags & IFF_OACTIVE)
2469: return;
2470:
2471: nextpkt:
2472: IFQ_DEQUEUE(&ifp->if_snd, m0);
2473: if (m0 == NULL)
2474: return;
2475:
2476: bzero((char *)&tx_frame, sizeof(tx_frame));
2477: tx_frame.wi_frame_ctl = htole16(WI_FTYPE_DATA | WI_STYPE_DATA);
2478: id = sc->wi_tx_data_id;
2479: eh = mtod(m0, struct ether_header *);
2480:
2481: if (sc->wi_ptype == WI_PORTTYPE_HOSTAP) {
2482: if (!wihap_check_tx(&sc->wi_hostap_info, eh->ether_dhost,
2483: &tx_frame.wi_tx_rate) && !(ifp->if_flags & IFF_PROMISC)) {
2484: if (ifp->if_flags & IFF_DEBUG)
2485: printf(WI_PRT_FMT
2486: ": wi_start: dropping unassoc dst %s\n",
2487: WI_PRT_ARG(sc),
2488: ether_sprintf(eh->ether_dhost));
2489: m_freem(m0);
2490: goto nextpkt;
2491: }
2492: }
2493:
2494: /*
2495: * Use RFC1042 encoding for IP and ARP datagrams,
2496: * 802.3 for anything else.
2497: */
2498: if (eh->ether_type == htons(ETHERTYPE_IP) ||
2499: eh->ether_type == htons(ETHERTYPE_ARP) ||
2500: eh->ether_type == htons(ETHERTYPE_REVARP) ||
2501: eh->ether_type == htons(ETHERTYPE_IPV6)) {
2502: bcopy((char *)&eh->ether_dhost,
2503: (char *)&tx_frame.wi_addr1, ETHER_ADDR_LEN);
2504: if (sc->wi_ptype == WI_PORTTYPE_HOSTAP) {
2505: tx_frame.wi_tx_ctl = htole16(WI_ENC_TX_MGMT); /* XXX */
2506: tx_frame.wi_frame_ctl |= htole16(WI_FCTL_FROMDS);
2507: bcopy((char *)&sc->sc_ic.ic_myaddr,
2508: (char *)&tx_frame.wi_addr2, ETHER_ADDR_LEN);
2509: bcopy((char *)&eh->ether_shost,
2510: (char *)&tx_frame.wi_addr3, ETHER_ADDR_LEN);
2511: if (sc->wi_use_wep)
2512: hostencrypt = 1;
2513: } else if (sc->wi_ptype == WI_PORTTYPE_BSS && sc->wi_use_wep &&
2514: sc->wi_crypto_algorithm != WI_CRYPTO_FIRMWARE_WEP) {
2515: tx_frame.wi_tx_ctl = htole16(WI_ENC_TX_MGMT); /* XXX */
2516: tx_frame.wi_frame_ctl |= htole16(WI_FCTL_TODS);
2517: bcopy((char *)&sc->sc_ic.ic_myaddr,
2518: (char *)&tx_frame.wi_addr2, ETHER_ADDR_LEN);
2519: bcopy((char *)&eh->ether_dhost,
2520: (char *)&tx_frame.wi_addr3, ETHER_ADDR_LEN);
2521: hostencrypt = 1;
2522: } else
2523: bcopy((char *)&eh->ether_shost,
2524: (char *)&tx_frame.wi_addr2, ETHER_ADDR_LEN);
2525: bcopy((char *)&eh->ether_dhost,
2526: (char *)&tx_frame.wi_dst_addr, ETHER_ADDR_LEN);
2527: bcopy((char *)&eh->ether_shost,
2528: (char *)&tx_frame.wi_src_addr, ETHER_ADDR_LEN);
2529:
2530: tx_frame.wi_dat_len = m0->m_pkthdr.len - WI_SNAPHDR_LEN;
2531: tx_frame.wi_dat[0] = htons(WI_SNAP_WORD0);
2532: tx_frame.wi_dat[1] = htons(WI_SNAP_WORD1);
2533: tx_frame.wi_len = htons(m0->m_pkthdr.len - WI_SNAPHDR_LEN);
2534: tx_frame.wi_type = eh->ether_type;
2535:
2536: if (hostencrypt) {
2537:
2538: /* Do host encryption. */
2539: tx_frame.wi_frame_ctl |= htole16(WI_FCTL_WEP);
2540: bcopy(&tx_frame.wi_dat[0], &sc->wi_txbuf[4], 8);
2541:
2542: m_copydata(m0, sizeof(struct ether_header),
2543: m0->m_pkthdr.len - sizeof(struct ether_header),
2544: (caddr_t)&sc->wi_txbuf[12]);
2545:
2546: wi_do_hostencrypt(sc, (caddr_t)&sc->wi_txbuf,
2547: tx_frame.wi_dat_len);
2548:
2549: tx_frame.wi_dat_len += IEEE80211_WEP_IVLEN +
2550: IEEE80211_WEP_KIDLEN + IEEE80211_WEP_CRCLEN;
2551:
2552: tx_frame.wi_dat_len = htole16(tx_frame.wi_dat_len);
2553: wi_write_data(sc, id, 0, (caddr_t)&tx_frame,
2554: sizeof(struct wi_frame));
2555: wi_write_data(sc, id, WI_802_11_OFFSET_RAW,
2556: (caddr_t)&sc->wi_txbuf,
2557: (m0->m_pkthdr.len -
2558: sizeof(struct ether_header)) + 18);
2559: } else {
2560: m_copydata(m0, sizeof(struct ether_header),
2561: m0->m_pkthdr.len - sizeof(struct ether_header),
2562: (caddr_t)&sc->wi_txbuf);
2563:
2564: tx_frame.wi_dat_len = htole16(tx_frame.wi_dat_len);
2565: wi_write_data(sc, id, 0, (caddr_t)&tx_frame,
2566: sizeof(struct wi_frame));
2567: wi_write_data(sc, id, WI_802_11_OFFSET,
2568: (caddr_t)&sc->wi_txbuf,
2569: (m0->m_pkthdr.len -
2570: sizeof(struct ether_header)) + 2);
2571: }
2572: } else {
2573: tx_frame.wi_dat_len = htole16(m0->m_pkthdr.len);
2574:
2575: if (sc->wi_ptype == WI_PORTTYPE_HOSTAP && sc->wi_use_wep) {
2576:
2577: /* Do host encryption. (XXX - not implemented) */
2578: printf(WI_PRT_FMT
2579: ": host encrypt not implemented for 802.3\n",
2580: WI_PRT_ARG(sc));
2581: } else {
2582: m_copydata(m0, 0, m0->m_pkthdr.len,
2583: (caddr_t)&sc->wi_txbuf);
2584:
2585: wi_write_data(sc, id, 0, (caddr_t)&tx_frame,
2586: sizeof(struct wi_frame));
2587: wi_write_data(sc, id, WI_802_3_OFFSET,
2588: (caddr_t)&sc->wi_txbuf, m0->m_pkthdr.len + 2);
2589: }
2590: }
2591:
2592: #if NBPFILTER > 0
2593: /*
2594: * If there's a BPF listener, bounce a copy of
2595: * this frame to him.
2596: */
2597: if (ifp->if_bpf)
2598: bpf_mtap(ifp->if_bpf, m0, BPF_DIRECTION_OUT);
2599: #endif
2600:
2601: m_freem(m0);
2602:
2603: ifp->if_flags |= IFF_OACTIVE;
2604:
2605: /*
2606: * Set a timeout in case the chip goes out to lunch.
2607: */
2608: ifp->if_timer = 5;
2609:
2610: if (wi_cmd(sc, WI_CMD_TX|WI_RECLAIM, id, 0, 0))
2611: printf(WI_PRT_FMT ": wi_start: xmit failed\n", WI_PRT_ARG(sc));
2612:
2613: return;
2614: }
2615:
2616: STATIC int
2617: wi_mgmt_xmit(struct wi_softc *sc, caddr_t data, int len)
2618: {
2619: struct wi_frame tx_frame;
2620: int id;
2621: struct wi_80211_hdr *hdr;
2622: caddr_t dptr;
2623:
2624: if (!(sc->wi_flags & WI_FLAGS_ATTACHED))
2625: return(ENODEV);
2626:
2627: hdr = (struct wi_80211_hdr *)data;
2628: dptr = data + sizeof(struct wi_80211_hdr);
2629:
2630: bzero((char *)&tx_frame, sizeof(tx_frame));
2631: id = sc->wi_tx_mgmt_id;
2632:
2633: bcopy((char *)hdr, (char *)&tx_frame.wi_frame_ctl,
2634: sizeof(struct wi_80211_hdr));
2635:
2636: tx_frame.wi_tx_ctl = htole16(WI_ENC_TX_MGMT);
2637: tx_frame.wi_dat_len = len - sizeof(struct wi_80211_hdr);
2638: tx_frame.wi_len = htole16(tx_frame.wi_dat_len);
2639:
2640: tx_frame.wi_dat_len = htole16(tx_frame.wi_dat_len);
2641: wi_write_data(sc, id, 0, (caddr_t)&tx_frame, sizeof(struct wi_frame));
2642: wi_write_data(sc, id, WI_802_11_OFFSET_RAW, dptr,
2643: (len - sizeof(struct wi_80211_hdr)) + 2);
2644:
2645: if (wi_cmd(sc, WI_CMD_TX|WI_RECLAIM, id, 0, 0)) {
2646: printf(WI_PRT_FMT ": wi_mgmt_xmit: xmit failed\n",
2647: WI_PRT_ARG(sc));
2648: /*
2649: * Hostile stations or corrupt frames may crash the card
2650: * and cause the kernel to get stuck printing complaints.
2651: * Reset the card and hope the problem goes away.
2652: */
2653: wi_reset(sc);
2654: return(EIO);
2655: }
2656:
2657: return(0);
2658: }
2659:
2660: void
2661: wi_stop(struct wi_softc *sc)
2662: {
2663: struct ifnet *ifp;
2664:
2665: wihap_shutdown(sc);
2666:
2667: if (!(sc->wi_flags & WI_FLAGS_ATTACHED))
2668: return;
2669:
2670: DPRINTF(WID_STOP, ("wi_stop: sc %p\n", sc));
2671:
2672: timeout_del(&sc->sc_timo);
2673:
2674: ifp = &sc->sc_ic.ic_if;
2675:
2676: wi_intr_enable(sc, 0);
2677: wi_cmd(sc, WI_CMD_DISABLE|sc->wi_portnum, 0, 0, 0);
2678:
2679: ifp->if_flags &= ~(IFF_RUNNING|IFF_OACTIVE);
2680: ifp->if_timer = 0;
2681:
2682: return;
2683: }
2684:
2685:
2686: void
2687: wi_watchdog(struct ifnet *ifp)
2688: {
2689: struct wi_softc *sc;
2690:
2691: sc = ifp->if_softc;
2692:
2693: printf(WI_PRT_FMT ": device timeout\n", WI_PRT_ARG(sc));
2694:
2695: wi_cor_reset(sc);
2696: wi_init(sc);
2697:
2698: ifp->if_oerrors++;
2699:
2700: return;
2701: }
2702:
2703: void
2704: wi_detach(struct wi_softc *sc)
2705: {
2706: struct ifnet *ifp;
2707: ifp = &sc->sc_ic.ic_if;
2708:
2709: if (ifp->if_flags & IFF_RUNNING)
2710: wi_stop(sc);
2711:
2712: if (sc->wi_flags & WI_FLAGS_ATTACHED) {
2713: sc->wi_flags &= ~WI_FLAGS_ATTACHED;
2714: if (sc->sc_sdhook != NULL)
2715: shutdownhook_disestablish(sc->sc_sdhook);
2716: }
2717: }
2718:
2719: STATIC void
2720: wi_shutdown(void *arg)
2721: {
2722: struct wi_softc *sc;
2723:
2724: sc = arg;
2725: wi_stop(sc);
2726:
2727: return;
2728: }
2729:
2730: STATIC void
2731: wi_get_id(struct wi_softc *sc)
2732: {
2733: struct wi_ltv_ver ver;
2734: const struct wi_card_ident *id;
2735: u_int16_t pri_fw_ver[3];
2736: const char *card_name;
2737: u_int16_t card_id;
2738:
2739: /* get chip identity */
2740: bzero(&ver, sizeof(ver));
2741: ver.wi_type = WI_RID_CARD_ID;
2742: ver.wi_len = 5;
2743: wi_read_record(sc, (struct wi_ltv_gen *)&ver);
2744: card_id = letoh16(ver.wi_ver[0]);
2745: for (id = wi_card_ident; id->firm_type != WI_NOTYPE; id++) {
2746: if (card_id == id->card_id)
2747: break;
2748: }
2749: if (id->firm_type != WI_NOTYPE) {
2750: sc->sc_firmware_type = id->firm_type;
2751: card_name = id->card_name;
2752: } else if (ver.wi_ver[0] & htole16(0x8000)) {
2753: sc->sc_firmware_type = WI_INTERSIL;
2754: card_name = "Unknown PRISM2 chip";
2755: } else {
2756: sc->sc_firmware_type = WI_LUCENT;
2757: }
2758:
2759: /* get primary firmware version (XXX - how to do Lucent?) */
2760: if (sc->sc_firmware_type != WI_LUCENT) {
2761: bzero(&ver, sizeof(ver));
2762: ver.wi_type = WI_RID_PRI_IDENTITY;
2763: ver.wi_len = 5;
2764: wi_read_record(sc, (struct wi_ltv_gen *)&ver);
2765: pri_fw_ver[0] = letoh16(ver.wi_ver[2]);
2766: pri_fw_ver[1] = letoh16(ver.wi_ver[3]);
2767: pri_fw_ver[2] = letoh16(ver.wi_ver[1]);
2768: }
2769:
2770: /* get station firmware version */
2771: bzero(&ver, sizeof(ver));
2772: ver.wi_type = WI_RID_STA_IDENTITY;
2773: ver.wi_len = 5;
2774: wi_read_record(sc, (struct wi_ltv_gen *)&ver);
2775: ver.wi_ver[1] = letoh16(ver.wi_ver[1]);
2776: ver.wi_ver[2] = letoh16(ver.wi_ver[2]);
2777: ver.wi_ver[3] = letoh16(ver.wi_ver[3]);
2778: sc->sc_sta_firmware_ver = ver.wi_ver[2] * 10000 +
2779: ver.wi_ver[3] * 100 + ver.wi_ver[1];
2780:
2781: if (sc->sc_firmware_type == WI_INTERSIL &&
2782: (sc->sc_sta_firmware_ver == 10102 || sc->sc_sta_firmware_ver == 20102)) {
2783: struct wi_ltv_str sver;
2784: char *p;
2785:
2786: bzero(&sver, sizeof(sver));
2787: sver.wi_type = WI_RID_SYMBOL_IDENTITY;
2788: sver.wi_len = 7;
2789: /* value should be something like "V2.00-11" */
2790: if (wi_read_record(sc, (struct wi_ltv_gen *)&sver) == 0 &&
2791: *(p = (char *)sver.wi_str) >= 'A' &&
2792: p[2] == '.' && p[5] == '-' && p[8] == '\0') {
2793: sc->sc_firmware_type = WI_SYMBOL;
2794: sc->sc_sta_firmware_ver = (p[1] - '0') * 10000 +
2795: (p[3] - '0') * 1000 + (p[4] - '0') * 100 +
2796: (p[6] - '0') * 10 + (p[7] - '0');
2797: }
2798: }
2799:
2800: if (sc->sc_firmware_type == WI_LUCENT) {
2801: printf("%s: Firmware %d.%02d variant %d, ", WI_PRT_ARG(sc),
2802: ver.wi_ver[2], ver.wi_ver[3], ver.wi_ver[1]);
2803: } else {
2804: printf("%s: %s%s (0x%04x), Firmware %d.%d.%d (primary), %d.%d.%d (station), ",
2805: WI_PRT_ARG(sc),
2806: sc->sc_firmware_type == WI_SYMBOL ? "Symbol " : "",
2807: card_name, card_id, pri_fw_ver[0], pri_fw_ver[1],
2808: pri_fw_ver[2], sc->sc_sta_firmware_ver / 10000,
2809: (sc->sc_sta_firmware_ver % 10000) / 100,
2810: sc->sc_sta_firmware_ver % 100);
2811: }
2812: }
2813:
2814: STATIC int
2815: wi_sync_media(struct wi_softc *sc, int ptype, int txrate)
2816: {
2817: int media = sc->sc_media.ifm_cur->ifm_media;
2818: int options = IFM_OPTIONS(media);
2819: int subtype;
2820:
2821: switch (txrate) {
2822: case 1:
2823: subtype = IFM_IEEE80211_DS1;
2824: break;
2825: case 2:
2826: subtype = IFM_IEEE80211_DS2;
2827: break;
2828: case 3:
2829: subtype = IFM_AUTO;
2830: break;
2831: case 5:
2832: subtype = IFM_IEEE80211_DS5;
2833: break;
2834: case 11:
2835: subtype = IFM_IEEE80211_DS11;
2836: break;
2837: default:
2838: subtype = IFM_MANUAL; /* Unable to represent */
2839: break;
2840: }
2841:
2842: options &= ~IFM_OMASK;
2843: switch (ptype) {
2844: case WI_PORTTYPE_BSS:
2845: /* default port type */
2846: break;
2847: case WI_PORTTYPE_ADHOC:
2848: options |= IFM_IEEE80211_ADHOC;
2849: break;
2850: case WI_PORTTYPE_HOSTAP:
2851: options |= IFM_IEEE80211_HOSTAP;
2852: break;
2853: case WI_PORTTYPE_IBSS:
2854: if (sc->wi_create_ibss)
2855: options |= IFM_IEEE80211_IBSSMASTER;
2856: else
2857: options |= IFM_IEEE80211_IBSS;
2858: break;
2859: default:
2860: subtype = IFM_MANUAL; /* Unable to represent */
2861: break;
2862: }
2863: media = IFM_MAKEWORD(IFM_TYPE(media), subtype, options,
2864: IFM_INST(media));
2865: if (ifmedia_match(&sc->sc_media, media, sc->sc_media.ifm_mask) == NULL)
2866: return (EINVAL);
2867: ifmedia_set(&sc->sc_media, media);
2868: sc->wi_ptype = ptype;
2869: sc->wi_tx_rate = txrate;
2870: return (0);
2871: }
2872:
2873: STATIC int
2874: wi_media_change(struct ifnet *ifp)
2875: {
2876: struct wi_softc *sc = ifp->if_softc;
2877: int otype = sc->wi_ptype;
2878: int orate = sc->wi_tx_rate;
2879: int ocreate_ibss = sc->wi_create_ibss;
2880:
2881: if ((sc->sc_media.ifm_cur->ifm_media & IFM_IEEE80211_HOSTAP) &&
2882: sc->sc_firmware_type != WI_INTERSIL)
2883: return (EINVAL);
2884:
2885: sc->wi_create_ibss = 0;
2886:
2887: switch (sc->sc_media.ifm_cur->ifm_media & IFM_OMASK) {
2888: case 0:
2889: sc->wi_ptype = WI_PORTTYPE_BSS;
2890: break;
2891: case IFM_IEEE80211_ADHOC:
2892: sc->wi_ptype = WI_PORTTYPE_ADHOC;
2893: break;
2894: case IFM_IEEE80211_HOSTAP:
2895: sc->wi_ptype = WI_PORTTYPE_HOSTAP;
2896: break;
2897: case IFM_IEEE80211_IBSSMASTER:
2898: case IFM_IEEE80211_IBSSMASTER|IFM_IEEE80211_IBSS:
2899: if (!(sc->wi_flags & WI_FLAGS_HAS_CREATE_IBSS))
2900: return (EINVAL);
2901: sc->wi_create_ibss = 1;
2902: /* FALLTHROUGH */
2903: case IFM_IEEE80211_IBSS:
2904: sc->wi_ptype = WI_PORTTYPE_IBSS;
2905: break;
2906: default:
2907: /* Invalid combination. */
2908: return (EINVAL);
2909: }
2910:
2911: switch (IFM_SUBTYPE(sc->sc_media.ifm_cur->ifm_media)) {
2912: case IFM_IEEE80211_DS1:
2913: sc->wi_tx_rate = 1;
2914: break;
2915: case IFM_IEEE80211_DS2:
2916: sc->wi_tx_rate = 2;
2917: break;
2918: case IFM_AUTO:
2919: sc->wi_tx_rate = 3;
2920: break;
2921: case IFM_IEEE80211_DS5:
2922: sc->wi_tx_rate = 5;
2923: break;
2924: case IFM_IEEE80211_DS11:
2925: sc->wi_tx_rate = 11;
2926: break;
2927: }
2928:
2929: if (sc->sc_ic.ic_if.if_flags & IFF_UP) {
2930: if (otype != sc->wi_ptype || orate != sc->wi_tx_rate ||
2931: ocreate_ibss != sc->wi_create_ibss)
2932: wi_init(sc);
2933: }
2934:
2935: ifp->if_baudrate = ifmedia_baudrate(sc->sc_media.ifm_cur->ifm_media);
2936:
2937: return (0);
2938: }
2939:
2940: STATIC void
2941: wi_media_status(struct ifnet *ifp, struct ifmediareq *imr)
2942: {
2943: struct wi_softc *sc = ifp->if_softc;
2944: struct wi_req wreq;
2945:
2946: if (!(sc->sc_ic.ic_if.if_flags & IFF_UP)) {
2947: imr->ifm_active = IFM_IEEE80211|IFM_NONE;
2948: imr->ifm_status = 0;
2949: return;
2950: }
2951:
2952: if (sc->wi_tx_rate == 3) {
2953: imr->ifm_active = IFM_IEEE80211|IFM_AUTO;
2954:
2955: wreq.wi_type = WI_RID_CUR_TX_RATE;
2956: wreq.wi_len = WI_MAX_DATALEN;
2957: if (wi_read_record(sc, (struct wi_ltv_gen *)&wreq) == 0) {
2958: switch (letoh16(wreq.wi_val[0])) {
2959: case 1:
2960: imr->ifm_active |= IFM_IEEE80211_DS1;
2961: break;
2962: case 2:
2963: imr->ifm_active |= IFM_IEEE80211_DS2;
2964: break;
2965: case 6:
2966: imr->ifm_active |= IFM_IEEE80211_DS5;
2967: break;
2968: case 11:
2969: imr->ifm_active |= IFM_IEEE80211_DS11;
2970: break;
2971: }
2972: }
2973: } else {
2974: imr->ifm_active = sc->sc_media.ifm_cur->ifm_media;
2975: }
2976:
2977: imr->ifm_status = IFM_AVALID;
2978: switch (sc->wi_ptype) {
2979: case WI_PORTTYPE_ADHOC:
2980: case WI_PORTTYPE_IBSS:
2981: /*
2982: * XXX: It would be nice if we could give some actually
2983: * useful status like whether we joined another IBSS or
2984: * created one ourselves.
2985: */
2986: /* FALLTHROUGH */
2987: case WI_PORTTYPE_HOSTAP:
2988: imr->ifm_status |= IFM_ACTIVE;
2989: break;
2990: default:
2991: wreq.wi_type = WI_RID_COMMQUAL;
2992: wreq.wi_len = WI_MAX_DATALEN;
2993: if (wi_read_record(sc, (struct wi_ltv_gen *)&wreq) == 0 &&
2994: letoh16(wreq.wi_val[0]) != 0)
2995: imr->ifm_status |= IFM_ACTIVE;
2996: }
2997: }
2998:
2999: STATIC int
3000: wi_set_nwkey(struct wi_softc *sc, struct ieee80211_nwkey *nwkey)
3001: {
3002: int i, len, error;
3003: struct wi_req wreq;
3004: struct wi_ltv_keys *wk = (struct wi_ltv_keys *)&wreq;
3005:
3006: if (!(sc->wi_flags & WI_FLAGS_HAS_WEP))
3007: return ENODEV;
3008: if (nwkey->i_defkid <= 0 || nwkey->i_defkid > IEEE80211_WEP_NKID)
3009: return EINVAL;
3010: memcpy(wk, &sc->wi_keys, sizeof(*wk));
3011: for (i = 0; i < IEEE80211_WEP_NKID; i++) {
3012: if (nwkey->i_key[i].i_keydat == NULL)
3013: continue;
3014: len = nwkey->i_key[i].i_keylen;
3015: if (len > sizeof(wk->wi_keys[i].wi_keydat))
3016: return EINVAL;
3017: error = copyin(nwkey->i_key[i].i_keydat,
3018: wk->wi_keys[i].wi_keydat, len);
3019: if (error)
3020: return error;
3021: wk->wi_keys[i].wi_keylen = htole16(len);
3022: }
3023:
3024: wk->wi_len = (sizeof(*wk) / 2) + 1;
3025: wk->wi_type = WI_RID_DEFLT_CRYPT_KEYS;
3026: if (sc->sc_ic.ic_if.if_flags & IFF_UP) {
3027: error = wi_write_record(sc, (struct wi_ltv_gen *)&wreq);
3028: if (error)
3029: return error;
3030: }
3031: if ((error = wi_setdef(sc, &wreq)))
3032: return (error);
3033:
3034: wreq.wi_len = 2;
3035: wreq.wi_type = WI_RID_TX_CRYPT_KEY;
3036: wreq.wi_val[0] = htole16(nwkey->i_defkid - 1);
3037: if (sc->sc_ic.ic_if.if_flags & IFF_UP) {
3038: error = wi_write_record(sc, (struct wi_ltv_gen *)&wreq);
3039: if (error)
3040: return error;
3041: }
3042: if ((error = wi_setdef(sc, &wreq)))
3043: return (error);
3044:
3045: wreq.wi_type = WI_RID_ENCRYPTION;
3046: wreq.wi_val[0] = htole16(nwkey->i_wepon);
3047: if (sc->sc_ic.ic_if.if_flags & IFF_UP) {
3048: error = wi_write_record(sc, (struct wi_ltv_gen *)&wreq);
3049: if (error)
3050: return error;
3051: }
3052: if ((error = wi_setdef(sc, &wreq)))
3053: return (error);
3054:
3055: if (sc->sc_ic.ic_if.if_flags & IFF_UP)
3056: wi_init(sc);
3057: return 0;
3058: }
3059:
3060: STATIC int
3061: wi_get_nwkey(struct wi_softc *sc, struct ieee80211_nwkey *nwkey)
3062: {
3063: int i, len, error;
3064: struct wi_ltv_keys *wk = &sc->wi_keys;
3065:
3066: if (!(sc->wi_flags & WI_FLAGS_HAS_WEP))
3067: return ENODEV;
3068: nwkey->i_wepon = sc->wi_use_wep;
3069: nwkey->i_defkid = sc->wi_tx_key + 1;
3070:
3071: /* do not show any keys to non-root user */
3072: error = suser(curproc, 0);
3073: for (i = 0; i < IEEE80211_WEP_NKID; i++) {
3074: if (nwkey->i_key[i].i_keydat == NULL)
3075: continue;
3076: /* error holds results of suser() for the first time */
3077: if (error)
3078: return error;
3079: len = letoh16(wk->wi_keys[i].wi_keylen);
3080: if (nwkey->i_key[i].i_keylen < len)
3081: return ENOSPC;
3082: nwkey->i_key[i].i_keylen = len;
3083: error = copyout(wk->wi_keys[i].wi_keydat,
3084: nwkey->i_key[i].i_keydat, len);
3085: if (error)
3086: return error;
3087: }
3088: return 0;
3089: }
3090:
3091: STATIC int
3092: wi_set_pm(struct wi_softc *sc, struct ieee80211_power *power)
3093: {
3094:
3095: sc->wi_pm_enabled = power->i_enabled;
3096: sc->wi_max_sleep = power->i_maxsleep;
3097:
3098: if (sc->sc_ic.ic_if.if_flags & IFF_UP)
3099: wi_init(sc);
3100:
3101: return (0);
3102: }
3103:
3104: STATIC int
3105: wi_get_pm(struct wi_softc *sc, struct ieee80211_power *power)
3106: {
3107:
3108: power->i_enabled = sc->wi_pm_enabled;
3109: power->i_maxsleep = sc->wi_max_sleep;
3110:
3111: return (0);
3112: }
3113:
3114: STATIC int
3115: wi_set_txpower(struct wi_softc *sc, struct ieee80211_txpower *txpower)
3116: {
3117: u_int16_t cmd;
3118: u_int16_t power;
3119: int8_t tmp;
3120: int error;
3121: int alc;
3122:
3123: if (txpower == NULL) {
3124: if (!(sc->wi_flags & WI_FLAGS_TXPOWER))
3125: return (EINVAL);
3126: alc = 0; /* disable ALC */
3127: } else {
3128: if (txpower->i_mode == IEEE80211_TXPOWER_MODE_AUTO) {
3129: alc = 1; /* enable ALC */
3130: sc->wi_flags &= ~WI_FLAGS_TXPOWER;
3131: } else {
3132: alc = 0; /* disable ALC */
3133: sc->wi_flags |= WI_FLAGS_TXPOWER;
3134: sc->wi_txpower = txpower->i_val;
3135: }
3136: }
3137:
3138: /* Set ALC */
3139: cmd = WI_CMD_DEBUG | (WI_DEBUG_CONFBITS << 8);
3140: if ((error = wi_cmd(sc, cmd, alc, 0x8, 0)) != 0)
3141: return (error);
3142:
3143: /* No need to set the TX power value if ALC is enabled */
3144: if (alc)
3145: return (0);
3146:
3147: /* Convert dBM to internal TX power value */
3148: if (sc->wi_txpower > 20)
3149: power = 128;
3150: else if (sc->wi_txpower < -43)
3151: power = 127;
3152: else {
3153: tmp = sc->wi_txpower;
3154: tmp = -12 - tmp;
3155: tmp <<= 2;
3156:
3157: power = (u_int16_t)tmp;
3158: }
3159:
3160: /* Set manual TX power */
3161: cmd = WI_CMD_WRITE_MIF;
3162: if ((error = wi_cmd(sc, cmd,
3163: WI_HFA384X_CR_MANUAL_TX_POWER, power, 0)) != 0)
3164: return (error);
3165:
3166: if (sc->sc_ic.ic_if.if_flags & IFF_DEBUG)
3167: printf("%s: %u (%d dBm)\n", sc->sc_dev.dv_xname, power,
3168: sc->wi_txpower);
3169:
3170: return (0);
3171: }
3172:
3173: STATIC int
3174: wi_get_txpower(struct wi_softc *sc, struct ieee80211_txpower *txpower)
3175: {
3176: u_int16_t cmd;
3177: u_int16_t power;
3178: int8_t tmp;
3179: int error;
3180:
3181: if (sc->wi_flags & WI_FLAGS_BUS_USB)
3182: return (EOPNOTSUPP);
3183:
3184: /* Get manual TX power */
3185: cmd = WI_CMD_READ_MIF;
3186: if ((error = wi_cmd(sc, cmd,
3187: WI_HFA384X_CR_MANUAL_TX_POWER, 0, 0)) != 0)
3188: return (error);
3189:
3190: power = CSR_READ_2(sc, WI_RESP0);
3191:
3192: /* Convert internal TX power value to dBM */
3193: if (power > 255)
3194: txpower->i_val = 255;
3195: else {
3196: tmp = power;
3197: tmp >>= 2;
3198: txpower->i_val = (u_int16_t)(-12 - tmp);
3199: }
3200:
3201: if (sc->wi_flags & WI_FLAGS_TXPOWER)
3202: txpower->i_mode = IEEE80211_TXPOWER_MODE_FIXED;
3203: else
3204: txpower->i_mode = IEEE80211_TXPOWER_MODE_AUTO;
3205:
3206: return (0);
3207: }
3208:
3209: STATIC int
3210: wi_set_ssid(struct ieee80211_nwid *ws, u_int8_t *id, int len)
3211: {
3212:
3213: if (len > IEEE80211_NWID_LEN)
3214: return (EINVAL);
3215: ws->i_len = len;
3216: memcpy(ws->i_nwid, id, len);
3217: return (0);
3218: }
3219:
3220: STATIC int
3221: wi_get_debug(struct wi_softc *sc, struct wi_req *wreq)
3222: {
3223: int error = 0;
3224:
3225: wreq->wi_len = 1;
3226:
3227: switch (wreq->wi_type) {
3228: case WI_DEBUG_SLEEP:
3229: wreq->wi_len++;
3230: wreq->wi_val[0] = htole16(sc->wi_debug.wi_sleep);
3231: break;
3232: case WI_DEBUG_DELAYSUPP:
3233: wreq->wi_len++;
3234: wreq->wi_val[0] = htole16(sc->wi_debug.wi_delaysupp);
3235: break;
3236: case WI_DEBUG_TXSUPP:
3237: wreq->wi_len++;
3238: wreq->wi_val[0] = htole16(sc->wi_debug.wi_txsupp);
3239: break;
3240: case WI_DEBUG_MONITOR:
3241: wreq->wi_len++;
3242: wreq->wi_val[0] = htole16(sc->wi_debug.wi_monitor);
3243: break;
3244: case WI_DEBUG_LEDTEST:
3245: wreq->wi_len += 3;
3246: wreq->wi_val[0] = htole16(sc->wi_debug.wi_ledtest);
3247: wreq->wi_val[1] = htole16(sc->wi_debug.wi_ledtest_param0);
3248: wreq->wi_val[2] = htole16(sc->wi_debug.wi_ledtest_param1);
3249: break;
3250: case WI_DEBUG_CONTTX:
3251: wreq->wi_len += 2;
3252: wreq->wi_val[0] = htole16(sc->wi_debug.wi_conttx);
3253: wreq->wi_val[1] = htole16(sc->wi_debug.wi_conttx_param0);
3254: break;
3255: case WI_DEBUG_CONTRX:
3256: wreq->wi_len++;
3257: wreq->wi_val[0] = htole16(sc->wi_debug.wi_contrx);
3258: break;
3259: case WI_DEBUG_SIGSTATE:
3260: wreq->wi_len += 2;
3261: wreq->wi_val[0] = htole16(sc->wi_debug.wi_sigstate);
3262: wreq->wi_val[1] = htole16(sc->wi_debug.wi_sigstate_param0);
3263: break;
3264: case WI_DEBUG_CONFBITS:
3265: wreq->wi_len += 2;
3266: wreq->wi_val[0] = htole16(sc->wi_debug.wi_confbits);
3267: wreq->wi_val[1] = htole16(sc->wi_debug.wi_confbits_param0);
3268: break;
3269: default:
3270: error = EIO;
3271: break;
3272: }
3273:
3274: return (error);
3275: }
3276:
3277: STATIC int
3278: wi_set_debug(struct wi_softc *sc, struct wi_req *wreq)
3279: {
3280: int error = 0;
3281: u_int16_t cmd, param0 = 0, param1 = 0;
3282:
3283: switch (wreq->wi_type) {
3284: case WI_DEBUG_RESET:
3285: case WI_DEBUG_INIT:
3286: case WI_DEBUG_CALENABLE:
3287: break;
3288: case WI_DEBUG_SLEEP:
3289: sc->wi_debug.wi_sleep = 1;
3290: break;
3291: case WI_DEBUG_WAKE:
3292: sc->wi_debug.wi_sleep = 0;
3293: break;
3294: case WI_DEBUG_CHAN:
3295: param0 = letoh16(wreq->wi_val[0]);
3296: break;
3297: case WI_DEBUG_DELAYSUPP:
3298: sc->wi_debug.wi_delaysupp = 1;
3299: break;
3300: case WI_DEBUG_TXSUPP:
3301: sc->wi_debug.wi_txsupp = 1;
3302: break;
3303: case WI_DEBUG_MONITOR:
3304: sc->wi_debug.wi_monitor = 1;
3305: break;
3306: case WI_DEBUG_LEDTEST:
3307: param0 = letoh16(wreq->wi_val[0]);
3308: param1 = letoh16(wreq->wi_val[1]);
3309: sc->wi_debug.wi_ledtest = 1;
3310: sc->wi_debug.wi_ledtest_param0 = param0;
3311: sc->wi_debug.wi_ledtest_param1 = param1;
3312: break;
3313: case WI_DEBUG_CONTTX:
3314: param0 = letoh16(wreq->wi_val[0]);
3315: sc->wi_debug.wi_conttx = 1;
3316: sc->wi_debug.wi_conttx_param0 = param0;
3317: break;
3318: case WI_DEBUG_STOPTEST:
3319: sc->wi_debug.wi_delaysupp = 0;
3320: sc->wi_debug.wi_txsupp = 0;
3321: sc->wi_debug.wi_monitor = 0;
3322: sc->wi_debug.wi_ledtest = 0;
3323: sc->wi_debug.wi_ledtest_param0 = 0;
3324: sc->wi_debug.wi_ledtest_param1 = 0;
3325: sc->wi_debug.wi_conttx = 0;
3326: sc->wi_debug.wi_conttx_param0 = 0;
3327: sc->wi_debug.wi_contrx = 0;
3328: sc->wi_debug.wi_sigstate = 0;
3329: sc->wi_debug.wi_sigstate_param0 = 0;
3330: break;
3331: case WI_DEBUG_CONTRX:
3332: sc->wi_debug.wi_contrx = 1;
3333: break;
3334: case WI_DEBUG_SIGSTATE:
3335: param0 = letoh16(wreq->wi_val[0]);
3336: sc->wi_debug.wi_sigstate = 1;
3337: sc->wi_debug.wi_sigstate_param0 = param0;
3338: break;
3339: case WI_DEBUG_CONFBITS:
3340: param0 = letoh16(wreq->wi_val[0]);
3341: param1 = letoh16(wreq->wi_val[1]);
3342: sc->wi_debug.wi_confbits = param0;
3343: sc->wi_debug.wi_confbits_param0 = param1;
3344: break;
3345: default:
3346: error = EIO;
3347: break;
3348: }
3349:
3350: if (error)
3351: return (error);
3352:
3353: cmd = WI_CMD_DEBUG | (wreq->wi_type << 8);
3354: error = wi_cmd(sc, cmd, param0, param1, 0);
3355:
3356: return (error);
3357: }
CVSweb