awi.c revision 1.48 1 1.48 onoe /* $NetBSD: awi.c,v 1.48 2002/09/30 06:38:10 onoe Exp $ */
2 1.3 sommerfe
3 1.19 onoe /*-
4 1.37 onoe * Copyright (c) 1999,2000,2001 The NetBSD Foundation, Inc.
5 1.1 sommerfe * All rights reserved.
6 1.1 sommerfe *
7 1.1 sommerfe * This code is derived from software contributed to The NetBSD Foundation
8 1.19 onoe * by Bill Sommerfeld
9 1.1 sommerfe *
10 1.1 sommerfe * Redistribution and use in source and binary forms, with or without
11 1.1 sommerfe * modification, are permitted provided that the following conditions
12 1.1 sommerfe * are met:
13 1.1 sommerfe * 1. Redistributions of source code must retain the above copyright
14 1.1 sommerfe * notice, this list of conditions and the following disclaimer.
15 1.1 sommerfe * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 sommerfe * notice, this list of conditions and the following disclaimer in the
17 1.1 sommerfe * documentation and/or other materials provided with the distribution.
18 1.1 sommerfe * 3. All advertising materials mentioning features or use of this software
19 1.1 sommerfe * must display the following acknowledgement:
20 1.19 onoe * This product includes software developed by the NetBSD
21 1.19 onoe * Foundation, Inc. and its contributors.
22 1.1 sommerfe * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.1 sommerfe * contributors may be used to endorse or promote products derived
24 1.1 sommerfe * from this software without specific prior written permission.
25 1.1 sommerfe *
26 1.1 sommerfe * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.1 sommerfe * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1 sommerfe * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.1 sommerfe * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.1 sommerfe * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1 sommerfe * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1 sommerfe * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1 sommerfe * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1 sommerfe * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1 sommerfe * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1 sommerfe * POSSIBILITY OF SUCH DAMAGE.
37 1.1 sommerfe */
38 1.19 onoe /*
39 1.19 onoe * Driver for AMD 802.11 firmware.
40 1.19 onoe * Uses am79c930 chip driver to talk to firmware running on the am79c930.
41 1.19 onoe *
42 1.19 onoe * More-or-less a generic ethernet-like if driver, with 802.11 gorp added.
43 1.19 onoe */
44 1.19 onoe
45 1.19 onoe /*
46 1.19 onoe * todo:
47 1.19 onoe * - flush tx queue on resynch.
48 1.19 onoe * - clear oactive on "down".
49 1.19 onoe * - rewrite copy-into-mbuf code
50 1.19 onoe * - mgmt state machine gets stuck retransmitting assoc requests.
51 1.19 onoe * - multicast filter.
52 1.19 onoe * - fix device reset so it's more likely to work
53 1.19 onoe * - show status goo through ifmedia.
54 1.19 onoe *
55 1.19 onoe * more todo:
56 1.19 onoe * - deal with more 802.11 frames.
57 1.19 onoe * - send reassoc request
58 1.19 onoe * - deal with reassoc response
59 1.19 onoe * - send/deal with disassociation
60 1.19 onoe * - deal with "full" access points (no room for me).
61 1.19 onoe * - power save mode
62 1.19 onoe *
63 1.19 onoe * later:
64 1.19 onoe * - SSID preferences
65 1.19 onoe * - need ioctls for poking at the MIBs
66 1.19 onoe * - implement ad-hoc mode (including bss creation).
67 1.19 onoe * - decide when to do "ad hoc" vs. infrastructure mode (IFF_LINK flags?)
68 1.19 onoe * (focus on inf. mode since that will be needed for ietf)
69 1.19 onoe * - deal with DH vs. FH versions of the card
70 1.19 onoe * - deal with faster cards (2mb/s)
71 1.19 onoe * - ?WEP goo (mmm, rc4) (it looks not particularly useful).
72 1.19 onoe * - ifmedia revision.
73 1.19 onoe * - common 802.11 mibish things.
74 1.19 onoe * - common 802.11 media layer.
75 1.19 onoe */
76 1.10 onoe
77 1.1 sommerfe /*
78 1.10 onoe * Driver for AMD 802.11 PCnetMobile firmware.
79 1.1 sommerfe * Uses am79c930 chip driver to talk to firmware running on the am79c930.
80 1.1 sommerfe *
81 1.10 onoe * The initial version of the driver was written by
82 1.10 onoe * Bill Sommerfeld <sommerfeld (at) netbsd.org>.
83 1.10 onoe * Then the driver module completely rewritten to support cards with DS phy
84 1.10 onoe * and to support adhoc mode by Atsushi Onoe <onoe (at) netbsd.org>
85 1.1 sommerfe */
86 1.41 lukem
87 1.41 lukem #include <sys/cdefs.h>
88 1.48 onoe __KERNEL_RCSID(0, "$NetBSD: awi.c,v 1.48 2002/09/30 06:38:10 onoe Exp $");
89 1.1 sommerfe
90 1.1 sommerfe #include "opt_inet.h"
91 1.10 onoe #include "bpfilter.h"
92 1.1 sommerfe
93 1.1 sommerfe #include <sys/param.h>
94 1.1 sommerfe #include <sys/systm.h>
95 1.1 sommerfe #include <sys/kernel.h>
96 1.1 sommerfe #include <sys/mbuf.h>
97 1.10 onoe #include <sys/malloc.h>
98 1.10 onoe #include <sys/proc.h>
99 1.1 sommerfe #include <sys/socket.h>
100 1.10 onoe #include <sys/sockio.h>
101 1.1 sommerfe #include <sys/errno.h>
102 1.1 sommerfe #include <sys/device.h>
103 1.1 sommerfe
104 1.1 sommerfe #include <net/if.h>
105 1.1 sommerfe #include <net/if_dl.h>
106 1.1 sommerfe #include <net/if_ether.h>
107 1.1 sommerfe #include <net/if_media.h>
108 1.10 onoe #include <net/if_llc.h>
109 1.10 onoe #include <net/if_ieee80211.h>
110 1.1 sommerfe
111 1.1 sommerfe #ifdef INET
112 1.1 sommerfe #include <netinet/in.h>
113 1.1 sommerfe #include <netinet/in_systm.h>
114 1.10 onoe #ifdef __NetBSD__
115 1.1 sommerfe #include <netinet/if_inarp.h>
116 1.10 onoe #else
117 1.10 onoe #include <netinet/if_ether.h>
118 1.10 onoe #endif
119 1.1 sommerfe #endif
120 1.1 sommerfe
121 1.1 sommerfe #if NBPFILTER > 0
122 1.1 sommerfe #include <net/bpf.h>
123 1.1 sommerfe #endif
124 1.1 sommerfe
125 1.1 sommerfe #include <machine/cpu.h>
126 1.1 sommerfe #include <machine/bus.h>
127 1.1 sommerfe #include <machine/intr.h>
128 1.1 sommerfe
129 1.1 sommerfe #include <dev/ic/am79c930reg.h>
130 1.1 sommerfe #include <dev/ic/am79c930var.h>
131 1.1 sommerfe #include <dev/ic/awireg.h>
132 1.1 sommerfe #include <dev/ic/awivar.h>
133 1.10 onoe
134 1.37 onoe static int awi_init(struct ifnet *);
135 1.37 onoe static void awi_stop(struct ifnet *, int);
136 1.37 onoe static void awi_start(struct ifnet *);
137 1.37 onoe static void awi_watchdog(struct ifnet *);
138 1.37 onoe static int awi_ioctl(struct ifnet *, u_long, caddr_t);
139 1.37 onoe static int awi_media_change(struct ifnet *);
140 1.37 onoe static void awi_media_status(struct ifnet *, struct ifmediareq *);
141 1.37 onoe static int awi_mode_init(struct awi_softc *);
142 1.37 onoe static void awi_rx_int(struct awi_softc *);
143 1.37 onoe static void awi_tx_int(struct awi_softc *);
144 1.37 onoe static struct mbuf *awi_devget(struct awi_softc *, u_int32_t, u_int16_t);
145 1.37 onoe static int awi_hw_init(struct awi_softc *);
146 1.37 onoe static int awi_init_mibs(struct awi_softc *);
147 1.37 onoe static int awi_chan_check(void *, u_char *);
148 1.37 onoe static int awi_mib(struct awi_softc *, u_int8_t, u_int8_t, int);
149 1.37 onoe static int awi_cmd(struct awi_softc *, u_int8_t, int);
150 1.37 onoe static int awi_cmd_wait(struct awi_softc *);
151 1.37 onoe static void awi_cmd_done(struct awi_softc *);
152 1.37 onoe static int awi_next_txd(struct awi_softc *, int, u_int32_t *, u_int32_t *);
153 1.37 onoe static int awi_lock(struct awi_softc *);
154 1.37 onoe static void awi_unlock(struct awi_softc *);
155 1.37 onoe static int awi_intr_lock(struct awi_softc *);
156 1.37 onoe static void awi_intr_unlock(struct awi_softc *);
157 1.37 onoe static int awi_newstate(void *, enum ieee80211_state);
158 1.37 onoe static struct mbuf *awi_ether_encap(struct awi_softc *, struct mbuf *);
159 1.37 onoe static struct mbuf *awi_ether_modcap(struct awi_softc *, struct mbuf *);
160 1.37 onoe
161 1.37 onoe /* unalligned little endian access */
162 1.37 onoe #define LE_READ_2(p) \
163 1.37 onoe ((((u_int8_t *)(p))[0] ) | (((u_int8_t *)(p))[1] << 8))
164 1.37 onoe #define LE_READ_4(p) \
165 1.37 onoe ((((u_int8_t *)(p))[0] ) | (((u_int8_t *)(p))[1] << 8) | \
166 1.37 onoe (((u_int8_t *)(p))[2] << 16) | (((u_int8_t *)(p))[3] << 24))
167 1.37 onoe #define LE_WRITE_2(p, v) \
168 1.37 onoe ((((u_int8_t *)(p))[0] = (((u_int32_t)(v) ) & 0xff)), \
169 1.37 onoe (((u_int8_t *)(p))[1] = (((u_int32_t)(v) >> 8) & 0xff)))
170 1.37 onoe #define LE_WRITE_4(p, v) \
171 1.37 onoe ((((u_int8_t *)(p))[0] = (((u_int32_t)(v) ) & 0xff)), \
172 1.37 onoe (((u_int8_t *)(p))[1] = (((u_int32_t)(v) >> 8) & 0xff)), \
173 1.37 onoe (((u_int8_t *)(p))[2] = (((u_int32_t)(v) >> 16) & 0xff)), \
174 1.37 onoe (((u_int8_t *)(p))[3] = (((u_int32_t)(v) >> 24) & 0xff)))
175 1.37 onoe
176 1.37 onoe struct awi_chanset awi_chanset[] = {
177 1.37 onoe /* PHY type domain min max def */
178 1.37 onoe { AWI_PHY_TYPE_FH, AWI_REG_DOMAIN_JP, 6, 17, 6 },
179 1.37 onoe { AWI_PHY_TYPE_FH, AWI_REG_DOMAIN_ES, 0, 26, 1 },
180 1.37 onoe { AWI_PHY_TYPE_FH, AWI_REG_DOMAIN_FR, 0, 32, 1 },
181 1.37 onoe { AWI_PHY_TYPE_FH, AWI_REG_DOMAIN_US, 0, 77, 1 },
182 1.37 onoe { AWI_PHY_TYPE_FH, AWI_REG_DOMAIN_CA, 0, 77, 1 },
183 1.37 onoe { AWI_PHY_TYPE_FH, AWI_REG_DOMAIN_EU, 0, 77, 1 },
184 1.37 onoe { AWI_PHY_TYPE_DS, AWI_REG_DOMAIN_JP, 14, 14, 14 },
185 1.37 onoe { AWI_PHY_TYPE_DS, AWI_REG_DOMAIN_ES, 10, 11, 10 },
186 1.37 onoe { AWI_PHY_TYPE_DS, AWI_REG_DOMAIN_FR, 10, 13, 10 },
187 1.37 onoe { AWI_PHY_TYPE_DS, AWI_REG_DOMAIN_US, 1, 11, 3 },
188 1.37 onoe { AWI_PHY_TYPE_DS, AWI_REG_DOMAIN_CA, 1, 11, 3 },
189 1.37 onoe { AWI_PHY_TYPE_DS, AWI_REG_DOMAIN_EU, 1, 13, 3 },
190 1.37 onoe { 0, 0 }
191 1.37 onoe };
192 1.10 onoe
193 1.10 onoe #ifdef AWI_DEBUG
194 1.37 onoe int awi_debug;
195 1.1 sommerfe
196 1.37 onoe #define DPRINTF(X) if (awi_debug) printf X
197 1.37 onoe #define DPRINTF2(X) if (awi_debug > 1) printf X
198 1.10 onoe #else
199 1.37 onoe #define DPRINTF(X)
200 1.37 onoe #define DPRINTF2(X)
201 1.10 onoe #endif
202 1.1 sommerfe
203 1.10 onoe int
204 1.37 onoe awi_attach(struct awi_softc *sc)
205 1.1 sommerfe {
206 1.37 onoe struct ieee80211com *ic = &sc->sc_ic;
207 1.37 onoe struct ifnet *ifp = &ic->ic_if;
208 1.37 onoe int s, i, error, nrate;
209 1.10 onoe int mword;
210 1.10 onoe struct ifmediareq imr;
211 1.1 sommerfe
212 1.10 onoe s = splnet();
213 1.10 onoe sc->sc_busy = 1;
214 1.37 onoe sc->sc_substate = AWI_ST_NONE;
215 1.37 onoe if ((error = awi_hw_init(sc)) != 0) {
216 1.10 onoe sc->sc_invalid = 1;
217 1.10 onoe splx(s);
218 1.10 onoe return error;
219 1.10 onoe }
220 1.10 onoe error = awi_init_mibs(sc);
221 1.37 onoe if (error != 0) {
222 1.10 onoe sc->sc_invalid = 1;
223 1.37 onoe splx(s);
224 1.10 onoe return error;
225 1.10 onoe }
226 1.10 onoe ifp->if_softc = sc;
227 1.37 onoe ifp->if_flags =
228 1.37 onoe IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST | IFF_NOTRAILERS;
229 1.37 onoe ifp->if_ioctl = awi_ioctl;
230 1.10 onoe ifp->if_start = awi_start;
231 1.35 onoe ifp->if_init = awi_init;
232 1.35 onoe ifp->if_stop = awi_stop;
233 1.37 onoe ifp->if_watchdog = awi_watchdog;
234 1.37 onoe IFQ_SET_READY(&ifp->if_snd);
235 1.10 onoe memcpy(ifp->if_xname, sc->sc_dev.dv_xname, IFNAMSIZ);
236 1.37 onoe
237 1.43 onoe if (sc->sc_mib_phy.IEEE_PHY_Type == AWI_PHY_TYPE_FH)
238 1.47 onoe ic->ic_phytype = IEEE80211_T_FH;
239 1.43 onoe else
240 1.47 onoe ic->ic_phytype = IEEE80211_T_DS;
241 1.47 onoe ic->ic_flags =
242 1.45 onoe IEEE80211_F_HASWEP | IEEE80211_F_HASIBSS | IEEE80211_F_HASHAP;
243 1.47 onoe ic->ic_opmode = IEEE80211_M_STA;
244 1.43 onoe ic->ic_state = IEEE80211_S_INIT;
245 1.37 onoe ic->ic_newstate = awi_newstate;
246 1.37 onoe ic->ic_chancheck = awi_chan_check;
247 1.37 onoe nrate = sc->sc_mib_phy.aSuprt_Data_Rates[1];
248 1.37 onoe memcpy(ic->ic_sup_rates, sc->sc_mib_phy.aSuprt_Data_Rates + 2, nrate);
249 1.47 onoe IEEE80211_ADDR_COPY(ic->ic_myaddr, sc->sc_mib_addr.aMAC_Address);
250 1.1 sommerfe
251 1.18 onoe printf("%s: IEEE802.11 %s %dMbps (firmware %s)\n",
252 1.10 onoe sc->sc_dev.dv_xname,
253 1.10 onoe sc->sc_mib_phy.IEEE_PHY_Type == AWI_PHY_TYPE_FH ? "FH" : "DS",
254 1.37 onoe (ic->ic_sup_rates[nrate - 1] & IEEE80211_RATE_VAL) / 2,
255 1.37 onoe sc->sc_banner);
256 1.37 onoe printf("%s: 802.11 address: %s\n", sc->sc_dev.dv_xname,
257 1.37 onoe ether_sprintf(ic->ic_myaddr));
258 1.37 onoe
259 1.10 onoe if_attach(ifp);
260 1.37 onoe ieee80211_ifattach(ifp);
261 1.1 sommerfe
262 1.43 onoe /* probe request is handled by hardware */
263 1.43 onoe ic->ic_send_mgmt[IEEE80211_FC0_SUBTYPE_PROBE_REQ
264 1.43 onoe >> IEEE80211_FC0_SUBTYPE_SHIFT] = NULL;
265 1.43 onoe ic->ic_recv_mgmt[IEEE80211_FC0_SUBTYPE_PROBE_REQ
266 1.43 onoe >> IEEE80211_FC0_SUBTYPE_SHIFT] = NULL;
267 1.43 onoe
268 1.10 onoe ifmedia_init(&sc->sc_media, 0, awi_media_change, awi_media_status);
269 1.45 onoe #define ADD(s, o) ifmedia_add(&sc->sc_media, \
270 1.45 onoe IFM_MAKEWORD(IFM_IEEE80211, (s), (o), 0), 0, NULL)
271 1.45 onoe ADD(IFM_AUTO, 0); /* infra mode */
272 1.45 onoe ADD(IFM_AUTO, IFM_FLAG0); /* melco compat mode */
273 1.45 onoe ADD(IFM_AUTO, IFM_IEEE80211_ADHOC); /* IBSS mode */
274 1.45 onoe if (sc->sc_mib_phy.IEEE_PHY_Type != AWI_PHY_TYPE_FH)
275 1.45 onoe ADD(IFM_AUTO, IFM_IEEE80211_ADHOC | IFM_FLAG0);
276 1.45 onoe /* lucent compat mode */
277 1.45 onoe ADD(IFM_AUTO, IFM_IEEE80211_HOSTAP);
278 1.37 onoe for (i = 0; i < nrate; i++) {
279 1.45 onoe mword = ieee80211_rate2media(ic->ic_sup_rates[i],
280 1.47 onoe ic->ic_phytype);
281 1.10 onoe if (mword == 0)
282 1.10 onoe continue;
283 1.45 onoe ADD(mword, 0);
284 1.45 onoe ADD(mword, IFM_FLAG0);
285 1.45 onoe ADD(mword, IFM_IEEE80211_ADHOC);
286 1.20 onoe if (sc->sc_mib_phy.IEEE_PHY_Type != AWI_PHY_TYPE_FH)
287 1.45 onoe ADD(mword, IFM_IEEE80211_ADHOC | IFM_FLAG0);
288 1.45 onoe ADD(mword, IFM_IEEE80211_HOSTAP);
289 1.1 sommerfe }
290 1.45 onoe #undef ADD
291 1.10 onoe awi_media_status(ifp, &imr);
292 1.10 onoe ifmedia_set(&sc->sc_media, imr.ifm_active);
293 1.37 onoe
294 1.37 onoe if ((sc->sc_sdhook = shutdownhook_establish(awi_shutdown, sc)) == NULL)
295 1.37 onoe printf("%s: WARNING: unable to establish shutdown hook\n",
296 1.37 onoe sc->sc_dev.dv_xname);
297 1.37 onoe if ((sc->sc_powerhook = powerhook_establish(awi_power, sc)) == NULL)
298 1.37 onoe printf("%s: WARNING: unable to establish power hook\n",
299 1.37 onoe sc->sc_dev.dv_xname);
300 1.37 onoe sc->sc_attached = 1;
301 1.37 onoe splx(s);
302 1.1 sommerfe
303 1.10 onoe /* ready to accept ioctl */
304 1.10 onoe awi_unlock(sc);
305 1.17 jhawk
306 1.10 onoe return 0;
307 1.1 sommerfe }
308 1.1 sommerfe
309 1.10 onoe int
310 1.37 onoe awi_detach(struct awi_softc *sc)
311 1.1 sommerfe {
312 1.37 onoe struct ifnet *ifp = &sc->sc_ic.ic_if;
313 1.10 onoe int s;
314 1.17 jhawk
315 1.17 jhawk if (!sc->sc_attached)
316 1.37 onoe return 0;
317 1.1 sommerfe
318 1.10 onoe s = splnet();
319 1.10 onoe sc->sc_invalid = 1;
320 1.35 onoe awi_stop(ifp, 1);
321 1.10 onoe while (sc->sc_sleep_cnt > 0) {
322 1.10 onoe wakeup(sc);
323 1.10 onoe (void)tsleep(sc, PWAIT, "awidet", 1);
324 1.1 sommerfe }
325 1.10 onoe ifmedia_delete_instance(&sc->sc_media, IFM_INST_ANY);
326 1.37 onoe ieee80211_ifdetach(ifp);
327 1.10 onoe if_detach(ifp);
328 1.37 onoe shutdownhook_disestablish(sc->sc_sdhook);
329 1.37 onoe powerhook_disestablish(sc->sc_powerhook);
330 1.10 onoe splx(s);
331 1.10 onoe return 0;
332 1.1 sommerfe }
333 1.1 sommerfe
334 1.1 sommerfe int
335 1.37 onoe awi_activate(struct device *self, enum devact act)
336 1.1 sommerfe {
337 1.10 onoe struct awi_softc *sc = (struct awi_softc *)self;
338 1.37 onoe struct ifnet *ifp = &sc->sc_ic.ic_if;
339 1.10 onoe int s, error = 0;
340 1.10 onoe
341 1.10 onoe s = splnet();
342 1.10 onoe switch (act) {
343 1.10 onoe case DVACT_ACTIVATE:
344 1.10 onoe error = EOPNOTSUPP;
345 1.10 onoe break;
346 1.10 onoe case DVACT_DEACTIVATE:
347 1.10 onoe sc->sc_invalid = 1;
348 1.37 onoe if_deactivate(ifp);
349 1.10 onoe break;
350 1.1 sommerfe }
351 1.10 onoe splx(s);
352 1.10 onoe return error;
353 1.1 sommerfe }
354 1.1 sommerfe
355 1.1 sommerfe void
356 1.37 onoe awi_power(int why, void *arg)
357 1.1 sommerfe {
358 1.37 onoe struct awi_softc *sc = arg;
359 1.37 onoe struct ifnet *ifp = &sc->sc_ic.ic_if;
360 1.10 onoe int s;
361 1.18 onoe int ocansleep;
362 1.10 onoe
363 1.37 onoe DPRINTF(("awi_power: %d\n", why));
364 1.10 onoe s = splnet();
365 1.18 onoe ocansleep = sc->sc_cansleep;
366 1.18 onoe sc->sc_cansleep = 0;
367 1.28 takemura switch (why) {
368 1.28 takemura case PWR_SUSPEND:
369 1.28 takemura case PWR_STANDBY:
370 1.35 onoe awi_stop(ifp, 1);
371 1.28 takemura break;
372 1.28 takemura case PWR_RESUME:
373 1.35 onoe if (ifp->if_flags & IFF_UP) {
374 1.35 onoe awi_init(ifp);
375 1.37 onoe (void)awi_intr(sc); /* make sure */
376 1.34 onoe }
377 1.28 takemura break;
378 1.28 takemura case PWR_SOFTSUSPEND:
379 1.28 takemura case PWR_SOFTSTANDBY:
380 1.28 takemura case PWR_SOFTRESUME:
381 1.28 takemura break;
382 1.18 onoe }
383 1.18 onoe sc->sc_cansleep = ocansleep;
384 1.10 onoe splx(s);
385 1.1 sommerfe }
386 1.1 sommerfe
387 1.37 onoe void
388 1.37 onoe awi_shutdown(void *arg)
389 1.10 onoe {
390 1.37 onoe struct awi_softc *sc = arg;
391 1.37 onoe struct ifnet *ifp = &sc->sc_ic.ic_if;
392 1.1 sommerfe
393 1.37 onoe if (sc->sc_attached)
394 1.37 onoe awi_stop(ifp, 1);
395 1.1 sommerfe }
396 1.1 sommerfe
397 1.1 sommerfe int
398 1.37 onoe awi_intr(void *arg)
399 1.1 sommerfe {
400 1.1 sommerfe struct awi_softc *sc = arg;
401 1.10 onoe u_int16_t status;
402 1.10 onoe int error, handled = 0, ocansleep;
403 1.37 onoe #ifdef AWI_DEBUG
404 1.37 onoe static const char *intname[] = {
405 1.37 onoe "CMD", "RX", "TX", "SCAN_CMPLT",
406 1.37 onoe "CFP_START", "DTIM", "CFP_ENDING", "GROGGY",
407 1.37 onoe "TXDATA", "TXBCAST", "TXPS", "TXCF",
408 1.37 onoe "TXMGT", "#13", "RXDATA", "RXMGT"
409 1.37 onoe };
410 1.37 onoe #endif
411 1.1 sommerfe
412 1.15 onoe if (!sc->sc_enabled || !sc->sc_enab_intr || sc->sc_invalid)
413 1.10 onoe return 0;
414 1.1 sommerfe
415 1.10 onoe am79c930_gcr_setbits(&sc->sc_chip,
416 1.10 onoe AM79C930_GCR_DISPWDN | AM79C930_GCR_ECINT);
417 1.1 sommerfe awi_write_1(sc, AWI_DIS_PWRDN, 1);
418 1.10 onoe ocansleep = sc->sc_cansleep;
419 1.10 onoe sc->sc_cansleep = 0;
420 1.10 onoe
421 1.1 sommerfe for (;;) {
422 1.37 onoe if ((error = awi_intr_lock(sc)) != 0)
423 1.10 onoe break;
424 1.10 onoe status = awi_read_1(sc, AWI_INTSTAT);
425 1.10 onoe awi_write_1(sc, AWI_INTSTAT, 0);
426 1.10 onoe awi_write_1(sc, AWI_INTSTAT, 0);
427 1.10 onoe status |= awi_read_1(sc, AWI_INTSTAT2) << 8;
428 1.10 onoe awi_write_1(sc, AWI_INTSTAT2, 0);
429 1.10 onoe DELAY(10);
430 1.10 onoe awi_intr_unlock(sc);
431 1.10 onoe if (!sc->sc_cmd_inprog)
432 1.10 onoe status &= ~AWI_INT_CMD; /* make sure */
433 1.10 onoe if (status == 0)
434 1.1 sommerfe break;
435 1.37 onoe #ifdef AWI_DEBUG
436 1.37 onoe if (awi_debug > 1) {
437 1.37 onoe int i;
438 1.37 onoe
439 1.37 onoe printf("awi_intr: status 0x%04x", status);
440 1.37 onoe for (i = 0; i < sizeof(intname)/sizeof(intname[0]);
441 1.37 onoe i++) {
442 1.37 onoe if (status & (1 << i))
443 1.37 onoe printf(" %s", intname[i]);
444 1.37 onoe }
445 1.37 onoe printf("\n");
446 1.37 onoe }
447 1.37 onoe #endif
448 1.1 sommerfe handled = 1;
449 1.10 onoe if (status & AWI_INT_RX)
450 1.37 onoe awi_rx_int(sc);
451 1.10 onoe if (status & AWI_INT_TX)
452 1.37 onoe awi_tx_int(sc);
453 1.10 onoe if (status & AWI_INT_CMD)
454 1.10 onoe awi_cmd_done(sc);
455 1.10 onoe if (status & AWI_INT_SCAN_CMPLT) {
456 1.43 onoe if (sc->sc_ic.ic_state == IEEE80211_S_SCAN &&
457 1.43 onoe sc->sc_substate == AWI_ST_NONE)
458 1.37 onoe ieee80211_next_scan(&sc->sc_ic.ic_if);
459 1.1 sommerfe }
460 1.1 sommerfe }
461 1.10 onoe sc->sc_cansleep = ocansleep;
462 1.1 sommerfe am79c930_gcr_clearbits(&sc->sc_chip, AM79C930_GCR_DISPWDN);
463 1.1 sommerfe awi_write_1(sc, AWI_DIS_PWRDN, 0);
464 1.1 sommerfe return handled;
465 1.1 sommerfe }
466 1.1 sommerfe
467 1.37 onoe static int
468 1.37 onoe awi_init(struct ifnet *ifp)
469 1.8 sommerfe {
470 1.35 onoe struct awi_softc *sc = ifp->if_softc;
471 1.37 onoe struct ieee80211com *ic = &sc->sc_ic;
472 1.47 onoe struct ieee80211_node *ni = &ic->ic_bss;
473 1.37 onoe int i, error;
474 1.8 sommerfe
475 1.37 onoe DPRINTF(("awi_init: enabled=%d\n", sc->sc_enabled));
476 1.37 onoe if (sc->sc_enabled) {
477 1.37 onoe awi_stop(ifp, 0);
478 1.37 onoe } else {
479 1.37 onoe if (sc->sc_enable)
480 1.37 onoe (*sc->sc_enable)(sc);
481 1.37 onoe sc->sc_enabled = 1;
482 1.37 onoe if ((error = awi_hw_init(sc)) != 0) {
483 1.37 onoe awi_stop(ifp, 1);
484 1.37 onoe return error;
485 1.37 onoe }
486 1.37 onoe }
487 1.37 onoe ic->ic_state = IEEE80211_S_INIT;
488 1.37 onoe
489 1.37 onoe sc->sc_mib_local.Network_Mode =
490 1.47 onoe (ic->ic_opmode == IEEE80211_M_ADHOC) ? 0 : 1;
491 1.45 onoe sc->sc_mib_local.Acting_as_AP =
492 1.47 onoe (ic->ic_opmode == IEEE80211_M_HOSTAP) ? 1 : 0;
493 1.42 onoe memset(&sc->sc_mib_mac.aDesired_ESS_ID, 0, AWI_ESS_ID_SIZE);
494 1.42 onoe sc->sc_mib_mac.aDesired_ESS_ID[0] = IEEE80211_ELEMID_SSID;
495 1.46 onoe sc->sc_mib_mac.aDesired_ESS_ID[1] = ic->ic_des_esslen;
496 1.46 onoe memcpy(&sc->sc_mib_mac.aDesired_ESS_ID[2], ic->ic_des_essid,
497 1.46 onoe ic->ic_des_esslen);
498 1.37 onoe
499 1.37 onoe if ((error = awi_mode_init(sc)) != 0) {
500 1.37 onoe DPRINTF(("awi_init: awi_mode_init failed %d\n", error));
501 1.37 onoe awi_stop(ifp, 1);
502 1.37 onoe return error;
503 1.10 onoe }
504 1.37 onoe
505 1.37 onoe /* start transmitter */
506 1.37 onoe sc->sc_txdone = sc->sc_txnext = sc->sc_txbase;
507 1.37 onoe awi_write_4(sc, sc->sc_txbase + AWI_TXD_START, 0);
508 1.37 onoe awi_write_4(sc, sc->sc_txbase + AWI_TXD_NEXT, 0);
509 1.37 onoe awi_write_4(sc, sc->sc_txbase + AWI_TXD_LENGTH, 0);
510 1.37 onoe awi_write_1(sc, sc->sc_txbase + AWI_TXD_RATE, 0);
511 1.37 onoe awi_write_4(sc, sc->sc_txbase + AWI_TXD_NDA, 0);
512 1.37 onoe awi_write_4(sc, sc->sc_txbase + AWI_TXD_NRA, 0);
513 1.37 onoe awi_write_1(sc, sc->sc_txbase + AWI_TXD_STATE, 0);
514 1.37 onoe awi_write_4(sc, AWI_CA_TX_DATA, sc->sc_txbase);
515 1.37 onoe awi_write_4(sc, AWI_CA_TX_MGT, 0);
516 1.37 onoe awi_write_4(sc, AWI_CA_TX_BCAST, 0);
517 1.37 onoe awi_write_4(sc, AWI_CA_TX_PS, 0);
518 1.37 onoe awi_write_4(sc, AWI_CA_TX_CF, 0);
519 1.37 onoe if ((error = awi_cmd(sc, AWI_CMD_INIT_TX, AWI_WAIT)) != 0) {
520 1.37 onoe DPRINTF(("awi_init: failed to start transmitter: %d\n", error));
521 1.37 onoe awi_stop(ifp, 1);
522 1.37 onoe return error;
523 1.10 onoe }
524 1.10 onoe
525 1.37 onoe /* start receiver */
526 1.37 onoe if ((error = awi_cmd(sc, AWI_CMD_INIT_RX, AWI_WAIT)) != 0) {
527 1.37 onoe DPRINTF(("awi_init: failed to start receiver: %d\n", error));
528 1.35 onoe awi_stop(ifp, 1);
529 1.10 onoe return error;
530 1.10 onoe }
531 1.37 onoe sc->sc_rxdoff = awi_read_4(sc, AWI_CA_IRX_DATA_DESC);
532 1.37 onoe sc->sc_rxmoff = awi_read_4(sc, AWI_CA_IRX_PS_DESC);
533 1.37 onoe
534 1.37 onoe ifp->if_flags |= IFF_RUNNING;
535 1.37 onoe ifp->if_flags &= ~IFF_OACTIVE;
536 1.37 onoe
537 1.47 onoe if ((ic->ic_opmode == IEEE80211_M_ADHOC && sc->sc_no_bssid) ||
538 1.47 onoe ic->ic_opmode == IEEE80211_M_HOSTAP) {
539 1.47 onoe ni->ni_chan = ic->ic_ibss_chan;
540 1.47 onoe ni->ni_intval = ic->ic_lintval;
541 1.47 onoe ni->ni_rssi = 0;
542 1.47 onoe ni->ni_rstamp = 0;
543 1.47 onoe memset(ni->ni_tstamp, 0, sizeof(ni->ni_tstamp));
544 1.47 onoe ni->ni_nrate = 0;
545 1.37 onoe for (i = 0; i < IEEE80211_RATE_SIZE; i++) {
546 1.37 onoe if (ic->ic_sup_rates[i])
547 1.47 onoe ni->ni_rates[ni->ni_nrate++] =
548 1.37 onoe ic->ic_sup_rates[i];
549 1.37 onoe }
550 1.47 onoe IEEE80211_ADDR_COPY(ni->ni_macaddr, ic->ic_myaddr);
551 1.47 onoe if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
552 1.47 onoe IEEE80211_ADDR_COPY(ni->ni_bssid, ic->ic_myaddr);
553 1.47 onoe ni->ni_esslen = ic->ic_des_esslen;
554 1.47 onoe memcpy(ni->ni_essid, ic->ic_des_essid, ni->ni_esslen);
555 1.47 onoe ni->ni_capinfo = IEEE80211_CAPINFO_ESS;
556 1.47 onoe if (ic->ic_phytype == IEEE80211_T_FH) {
557 1.47 onoe ni->ni_fhdwell = 200; /* XXX */
558 1.47 onoe ni->ni_fhindex = 1;
559 1.45 onoe }
560 1.45 onoe } else {
561 1.47 onoe ni->ni_capinfo = IEEE80211_CAPINFO_IBSS;
562 1.47 onoe memset(ni->ni_bssid, 0, IEEE80211_ADDR_LEN);
563 1.47 onoe ni->ni_esslen = 0;
564 1.45 onoe }
565 1.45 onoe if (ic->ic_flags & IEEE80211_F_WEPON)
566 1.47 onoe ni->ni_capinfo |= IEEE80211_CAPINFO_PRIVACY;
567 1.37 onoe ic->ic_flags |= IEEE80211_F_SIBSS;
568 1.37 onoe ic->ic_state = IEEE80211_S_SCAN; /*XXX*/
569 1.37 onoe sc->sc_substate = AWI_ST_NONE;
570 1.37 onoe ieee80211_new_state(&ic->ic_if, IEEE80211_S_RUN, -1);
571 1.37 onoe } else {
572 1.47 onoe ni->ni_chan = sc->sc_cur_chan;
573 1.37 onoe ieee80211_new_state(&ic->ic_if, IEEE80211_S_SCAN, -1);
574 1.10 onoe }
575 1.37 onoe return 0;
576 1.8 sommerfe }
577 1.8 sommerfe
578 1.37 onoe static void
579 1.37 onoe awi_stop(struct ifnet *ifp, int disable)
580 1.1 sommerfe {
581 1.35 onoe struct awi_softc *sc = ifp->if_softc;
582 1.8 sommerfe
583 1.37 onoe if (!sc->sc_enabled)
584 1.37 onoe return;
585 1.37 onoe
586 1.37 onoe DPRINTF(("awi_stop(%d)\n", disable));
587 1.37 onoe
588 1.37 onoe ieee80211_new_state(&sc->sc_ic.ic_if, IEEE80211_S_INIT, -1);
589 1.37 onoe
590 1.37 onoe if (!sc->sc_invalid) {
591 1.37 onoe if (sc->sc_cmd_inprog)
592 1.37 onoe (void)awi_cmd_wait(sc);
593 1.37 onoe (void)awi_cmd(sc, AWI_CMD_KILL_RX, AWI_WAIT);
594 1.37 onoe sc->sc_cmd_inprog = AWI_CMD_FLUSH_TX;
595 1.37 onoe awi_write_1(sc, AWI_CA_FTX_DATA, 1);
596 1.37 onoe awi_write_1(sc, AWI_CA_FTX_MGT, 0);
597 1.37 onoe awi_write_1(sc, AWI_CA_FTX_BCAST, 0);
598 1.37 onoe awi_write_1(sc, AWI_CA_FTX_PS, 0);
599 1.37 onoe awi_write_1(sc, AWI_CA_FTX_CF, 0);
600 1.37 onoe (void)awi_cmd(sc, AWI_CMD_FLUSH_TX, AWI_WAIT);
601 1.10 onoe }
602 1.10 onoe ifp->if_flags &= ~(IFF_RUNNING|IFF_OACTIVE);
603 1.1 sommerfe ifp->if_timer = 0;
604 1.37 onoe sc->sc_tx_timer = sc->sc_rx_timer = 0;
605 1.37 onoe if (sc->sc_rxpend != NULL) {
606 1.37 onoe m_freem(sc->sc_rxpend);
607 1.37 onoe sc->sc_rxpend = NULL;
608 1.37 onoe }
609 1.29 thorpej IFQ_PURGE(&ifp->if_snd);
610 1.37 onoe
611 1.37 onoe if (disable) {
612 1.35 onoe if (sc->sc_disable)
613 1.35 onoe (*sc->sc_disable)(sc);
614 1.35 onoe sc->sc_enabled = 0;
615 1.18 onoe }
616 1.1 sommerfe }
617 1.1 sommerfe
618 1.10 onoe static void
619 1.37 onoe awi_start(struct ifnet *ifp)
620 1.1 sommerfe {
621 1.1 sommerfe struct awi_softc *sc = ifp->if_softc;
622 1.37 onoe struct ieee80211com *ic = &sc->sc_ic;
623 1.47 onoe struct ieee80211_frame *wh;
624 1.37 onoe struct mbuf *m, *m0;
625 1.43 onoe int len, dowep;
626 1.37 onoe u_int32_t txd, frame, ntxd;
627 1.37 onoe u_int8_t rate;
628 1.1 sommerfe
629 1.37 onoe if (!sc->sc_enabled || sc->sc_invalid)
630 1.1 sommerfe return;
631 1.1 sommerfe
632 1.10 onoe for (;;) {
633 1.10 onoe txd = sc->sc_txnext;
634 1.37 onoe IF_POLL(&ic->ic_mgtq, m0);
635 1.43 onoe dowep = 0;
636 1.10 onoe if (m0 != NULL) {
637 1.43 onoe len = m0->m_pkthdr.len;
638 1.43 onoe if (awi_next_txd(sc, len, &frame, &ntxd)) {
639 1.10 onoe ifp->if_flags |= IFF_OACTIVE;
640 1.10 onoe break;
641 1.10 onoe }
642 1.37 onoe IF_DEQUEUE(&ic->ic_mgtq, m0);
643 1.10 onoe } else {
644 1.37 onoe if (ic->ic_state != IEEE80211_S_RUN)
645 1.10 onoe break;
646 1.29 thorpej IFQ_POLL(&ifp->if_snd, m0);
647 1.10 onoe if (m0 == NULL)
648 1.10 onoe break;
649 1.37 onoe /*
650 1.37 onoe * Need to calculate the real length to determine
651 1.37 onoe * if the transmit buffer has a room for the packet.
652 1.37 onoe */
653 1.18 onoe len = m0->m_pkthdr.len + sizeof(struct ieee80211_frame);
654 1.37 onoe if (!(ifp->if_flags & IFF_LINK0) && !sc->sc_adhoc_ap)
655 1.18 onoe len += sizeof(struct llc) -
656 1.18 onoe sizeof(struct ether_header);
657 1.43 onoe if (ic->ic_flags & IEEE80211_F_WEPON) {
658 1.43 onoe dowep = 1;
659 1.18 onoe len += IEEE80211_WEP_IVLEN +
660 1.18 onoe IEEE80211_WEP_KIDLEN + IEEE80211_WEP_CRCLEN;
661 1.43 onoe }
662 1.18 onoe if (awi_next_txd(sc, len, &frame, &ntxd)) {
663 1.10 onoe ifp->if_flags |= IFF_OACTIVE;
664 1.1 sommerfe break;
665 1.10 onoe }
666 1.29 thorpej IFQ_DEQUEUE(&ifp->if_snd, m0);
667 1.37 onoe ifp->if_opackets++;
668 1.37 onoe #if NBPFILTER > 0
669 1.37 onoe if (ifp->if_bpf)
670 1.37 onoe bpf_mtap(ifp->if_bpf, m0);
671 1.33 onoe #endif
672 1.37 onoe if ((ifp->if_flags & IFF_LINK0) || sc->sc_adhoc_ap)
673 1.37 onoe m0 = awi_ether_encap(sc, m0);
674 1.37 onoe else
675 1.37 onoe m0 = ieee80211_encap(ifp, m0);
676 1.10 onoe if (m0 == NULL) {
677 1.10 onoe ifp->if_oerrors++;
678 1.10 onoe continue;
679 1.10 onoe }
680 1.47 onoe wh = mtod(m0, struct ieee80211_frame *);
681 1.47 onoe if (!IEEE80211_IS_MULTICAST(wh->i_addr1) &&
682 1.47 onoe ic->ic_opmode != IEEE80211_M_STA &&
683 1.47 onoe sc->sc_no_bssid == 0 &&
684 1.47 onoe sc->sc_adhoc_ap == 0 &&
685 1.47 onoe (ifp->if_flags & IFF_LINK0) == 0 &&
686 1.47 onoe (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) ==
687 1.47 onoe IEEE80211_FC0_TYPE_DATA &&
688 1.47 onoe ieee80211_find_node(ic, wh->i_addr1) == NULL) {
689 1.47 onoe m_freem(m0);
690 1.47 onoe ifp->if_oerrors++;
691 1.47 onoe continue;
692 1.47 onoe }
693 1.43 onoe }
694 1.44 onoe #if NBPFILTER > 0
695 1.44 onoe if (ic->ic_rawbpf)
696 1.44 onoe bpf_mtap(ic->ic_rawbpf, m0);
697 1.44 onoe #endif
698 1.43 onoe if (dowep) {
699 1.43 onoe if ((m0 = ieee80211_wep_crypt(ifp, m0, 1)) == NULL) {
700 1.37 onoe ifp->if_oerrors++;
701 1.37 onoe continue;
702 1.37 onoe }
703 1.43 onoe }
704 1.43 onoe #ifdef DIAGNOSTIC
705 1.43 onoe if (m0->m_pkthdr.len != len) {
706 1.43 onoe printf("%s: length %d should be %d\n",
707 1.43 onoe ifp->if_xname, m0->m_pkthdr.len, len);
708 1.43 onoe m_freem(m0);
709 1.43 onoe ifp->if_oerrors++;
710 1.43 onoe continue;
711 1.43 onoe }
712 1.37 onoe #endif
713 1.37 onoe
714 1.37 onoe if ((ifp->if_flags & IFF_DEBUG) && (ifp->if_flags & IFF_LINK2))
715 1.37 onoe ieee80211_dump_pkt(m0->m_data, m0->m_len,
716 1.47 onoe ic->ic_bss.ni_rates[ic->ic_bss.ni_txrate] &
717 1.37 onoe IEEE80211_RATE_VAL, -1);
718 1.37 onoe
719 1.37 onoe for (m = m0, len = 0; m != NULL; m = m->m_next) {
720 1.10 onoe awi_write_bytes(sc, frame + len, mtod(m, u_int8_t *),
721 1.10 onoe m->m_len);
722 1.10 onoe len += m->m_len;
723 1.4 sommerfe }
724 1.10 onoe m_freem(m0);
725 1.47 onoe rate = (ic->ic_bss.ni_rates[ic->ic_bss.ni_txrate] &
726 1.37 onoe IEEE80211_RATE_VAL) * 5;
727 1.10 onoe awi_write_1(sc, ntxd + AWI_TXD_STATE, 0);
728 1.10 onoe awi_write_4(sc, txd + AWI_TXD_START, frame);
729 1.10 onoe awi_write_4(sc, txd + AWI_TXD_NEXT, ntxd);
730 1.10 onoe awi_write_4(sc, txd + AWI_TXD_LENGTH, len);
731 1.10 onoe awi_write_1(sc, txd + AWI_TXD_RATE, rate);
732 1.10 onoe awi_write_4(sc, txd + AWI_TXD_NDA, 0);
733 1.10 onoe awi_write_4(sc, txd + AWI_TXD_NRA, 0);
734 1.10 onoe awi_write_1(sc, txd + AWI_TXD_STATE, AWI_TXD_ST_OWN);
735 1.10 onoe sc->sc_txnext = ntxd;
736 1.37 onoe
737 1.37 onoe sc->sc_tx_timer = 5;
738 1.10 onoe ifp->if_timer = 1;
739 1.1 sommerfe }
740 1.1 sommerfe }
741 1.1 sommerfe
742 1.10 onoe static void
743 1.37 onoe awi_watchdog(struct ifnet *ifp)
744 1.1 sommerfe {
745 1.37 onoe struct awi_softc *sc = ifp->if_softc;
746 1.37 onoe u_int32_t prevdone;
747 1.37 onoe int ocansleep;
748 1.37 onoe
749 1.37 onoe ifp->if_timer = 0;
750 1.37 onoe if (!sc->sc_enabled || sc->sc_invalid)
751 1.37 onoe return;
752 1.9 sommerfe
753 1.37 onoe ocansleep = sc->sc_cansleep;
754 1.37 onoe sc->sc_cansleep = 0;
755 1.37 onoe if (sc->sc_tx_timer) {
756 1.37 onoe if (--sc->sc_tx_timer == 0) {
757 1.37 onoe printf("%s: device timeout\n", ifp->if_xname);
758 1.37 onoe prevdone = sc->sc_txdone;
759 1.37 onoe awi_tx_int(sc);
760 1.37 onoe if (sc->sc_txdone == prevdone) {
761 1.37 onoe ifp->if_oerrors++;
762 1.37 onoe awi_init(ifp);
763 1.37 onoe goto out;
764 1.37 onoe }
765 1.37 onoe }
766 1.37 onoe ifp->if_timer = 1;
767 1.37 onoe }
768 1.37 onoe if (sc->sc_rx_timer) {
769 1.37 onoe if (--sc->sc_rx_timer == 0) {
770 1.37 onoe if (sc->sc_ic.ic_state == IEEE80211_S_RUN) {
771 1.37 onoe ieee80211_new_state(ifp, IEEE80211_S_SCAN, -1);
772 1.37 onoe goto out;
773 1.37 onoe }
774 1.37 onoe } else
775 1.37 onoe ifp->if_timer = 1;
776 1.10 onoe }
777 1.37 onoe /* TODO: rate control */
778 1.37 onoe ieee80211_watchdog(ifp);
779 1.37 onoe out:
780 1.37 onoe sc->sc_cansleep = ocansleep;
781 1.10 onoe }
782 1.9 sommerfe
783 1.37 onoe static int
784 1.37 onoe awi_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
785 1.10 onoe {
786 1.37 onoe struct awi_softc *sc = ifp->if_softc;
787 1.37 onoe struct ifreq *ifr = (struct ifreq *)data;
788 1.37 onoe int s, error;
789 1.10 onoe
790 1.37 onoe s = splnet();
791 1.37 onoe /* serialize ioctl, since we may sleep */
792 1.37 onoe if ((error = awi_lock(sc)) != 0)
793 1.37 onoe goto cantlock;
794 1.1 sommerfe
795 1.37 onoe switch (cmd) {
796 1.37 onoe case SIOCSIFFLAGS:
797 1.37 onoe if (ifp->if_flags & IFF_UP) {
798 1.37 onoe if (sc->sc_enabled) {
799 1.37 onoe /*
800 1.37 onoe * To avoid rescanning another access point,
801 1.37 onoe * do not call awi_init() here. Instead,
802 1.37 onoe * only reflect promisc mode settings.
803 1.37 onoe */
804 1.37 onoe error = awi_mode_init(sc);
805 1.37 onoe } else
806 1.37 onoe error = awi_init(ifp);
807 1.37 onoe } else if (sc->sc_enabled)
808 1.37 onoe awi_stop(ifp, 1);
809 1.37 onoe break;
810 1.37 onoe case SIOCSIFMEDIA:
811 1.37 onoe case SIOCGIFMEDIA:
812 1.37 onoe error = ifmedia_ioctl(ifp, ifr, &sc->sc_media, cmd);
813 1.37 onoe break;
814 1.37 onoe case SIOCADDMULTI:
815 1.37 onoe case SIOCDELMULTI:
816 1.37 onoe error = (cmd == SIOCADDMULTI) ?
817 1.37 onoe ether_addmulti(ifr, &sc->sc_ic.ic_ec) :
818 1.37 onoe ether_delmulti(ifr, &sc->sc_ic.ic_ec);
819 1.37 onoe if (error == ENETRESET) {
820 1.37 onoe /* do not rescan */
821 1.37 onoe if (sc->sc_enabled)
822 1.37 onoe error = awi_mode_init(sc);
823 1.37 onoe else
824 1.37 onoe error = 0;
825 1.37 onoe }
826 1.37 onoe break;
827 1.37 onoe default:
828 1.37 onoe error = ieee80211_ioctl(ifp, cmd, data);
829 1.37 onoe if (error == ENETRESET) {
830 1.37 onoe if (sc->sc_enabled)
831 1.37 onoe error = awi_init(ifp);
832 1.37 onoe else
833 1.37 onoe error = 0;
834 1.37 onoe }
835 1.37 onoe break;
836 1.1 sommerfe }
837 1.37 onoe awi_unlock(sc);
838 1.37 onoe cantlock:
839 1.37 onoe splx(s);
840 1.37 onoe return error;
841 1.10 onoe }
842 1.9 sommerfe
843 1.37 onoe /*
844 1.37 onoe * Called from ifmedia_ioctl via awi_ioctl with lock obtained.
845 1.37 onoe */
846 1.37 onoe static int
847 1.37 onoe awi_media_change(struct ifnet *ifp)
848 1.10 onoe {
849 1.37 onoe struct awi_softc *sc = ifp->if_softc;
850 1.37 onoe struct ieee80211com *ic = &sc->sc_ic;
851 1.37 onoe struct ifmedia_entry *ime;
852 1.37 onoe int i, rate, error = 0;
853 1.1 sommerfe
854 1.37 onoe ime = sc->sc_media.ifm_cur;
855 1.37 onoe if (IFM_SUBTYPE(ime->ifm_media) == IFM_AUTO) {
856 1.37 onoe ic->ic_fixed_rate = -1;
857 1.37 onoe } else {
858 1.47 onoe rate = ieee80211_media2rate(ime->ifm_media, ic->ic_phytype);
859 1.37 onoe if (rate == 0)
860 1.37 onoe return EINVAL;
861 1.37 onoe for (i = 0; i < IEEE80211_RATE_SIZE; i++) {
862 1.37 onoe if ((ic->ic_sup_rates[i] & IEEE80211_RATE_VAL) == rate)
863 1.37 onoe break;
864 1.37 onoe }
865 1.37 onoe if (i == IEEE80211_RATE_SIZE)
866 1.37 onoe return EINVAL;
867 1.37 onoe ic->ic_fixed_rate = i;
868 1.10 onoe }
869 1.37 onoe
870 1.37 onoe /*
871 1.47 onoe * combination of mediaopt
872 1.47 onoe *
873 1.47 onoe * hostap adhoc flag0 opmode no_bssid adhoc_ap comment
874 1.47 onoe * + - - HOSTAP 0 0 HostAP
875 1.47 onoe * - + - ADHOC 0 0 IBSS
876 1.47 onoe * - + + ADHOC 1 0 WaveLAN adhoc
877 1.47 onoe * - - + ADHOC 0 1 Melco old Sta
878 1.47 onoe * also LINK0
879 1.47 onoe * - - - STA 0 0 Infra Station
880 1.37 onoe */
881 1.48 onoe ic->ic_flags &= ~IEEE80211_F_IBSSON;
882 1.47 onoe if (ime->ifm_media & IFM_IEEE80211_HOSTAP) {
883 1.47 onoe if (ic->ic_opmode != IEEE80211_M_HOSTAP) {
884 1.47 onoe ic->ic_opmode = IEEE80211_M_HOSTAP;
885 1.47 onoe sc->sc_no_bssid = 0;
886 1.45 onoe sc->sc_adhoc_ap = 0;
887 1.37 onoe error = ENETRESET;
888 1.37 onoe }
889 1.47 onoe } else if (ime->ifm_media & IFM_IEEE80211_ADHOC) {
890 1.47 onoe if (ic->ic_opmode != IEEE80211_M_ADHOC ||
891 1.47 onoe sc->sc_adhoc_ap != 0) {
892 1.47 onoe ic->ic_opmode = IEEE80211_M_ADHOC;
893 1.47 onoe sc->sc_adhoc_ap = 0;
894 1.47 onoe error = ENETRESET;
895 1.47 onoe }
896 1.47 onoe if (ic->ic_phytype == IEEE80211_T_DS &&
897 1.37 onoe (ime->ifm_media & IFM_FLAG0)) {
898 1.37 onoe if (sc->sc_no_bssid == 0) {
899 1.37 onoe sc->sc_no_bssid = 1;
900 1.37 onoe error = ENETRESET;
901 1.37 onoe }
902 1.37 onoe } else {
903 1.37 onoe if (sc->sc_no_bssid) {
904 1.37 onoe sc->sc_no_bssid = 0;
905 1.37 onoe error = ENETRESET;
906 1.37 onoe }
907 1.48 onoe ic->ic_flags |= IEEE80211_F_IBSSON;
908 1.37 onoe }
909 1.45 onoe } else if (ime->ifm_media & IFM_FLAG0) {
910 1.47 onoe if (ic->ic_opmode != IEEE80211_M_ADHOC ||
911 1.47 onoe sc->sc_adhoc_ap == 0) {
912 1.47 onoe ic->ic_opmode = IEEE80211_M_ADHOC;
913 1.45 onoe sc->sc_adhoc_ap = 1;
914 1.45 onoe sc->sc_no_bssid = 0;
915 1.37 onoe error = ENETRESET;
916 1.10 onoe }
917 1.10 onoe } else {
918 1.47 onoe if (ic->ic_opmode != IEEE80211_M_STA) {
919 1.47 onoe ic->ic_opmode = IEEE80211_M_STA;
920 1.37 onoe sc->sc_no_bssid = 0;
921 1.45 onoe sc->sc_adhoc_ap = 0;
922 1.37 onoe error = ENETRESET;
923 1.37 onoe }
924 1.20 onoe }
925 1.37 onoe if (error == ENETRESET) {
926 1.37 onoe if (sc->sc_enabled)
927 1.37 onoe error = awi_init(ifp);
928 1.37 onoe else
929 1.37 onoe error = 0;
930 1.37 onoe }
931 1.37 onoe return error;
932 1.1 sommerfe }
933 1.1 sommerfe
934 1.10 onoe static void
935 1.37 onoe awi_media_status(struct ifnet *ifp, struct ifmediareq *imr)
936 1.1 sommerfe {
937 1.37 onoe struct awi_softc *sc = ifp->if_softc;
938 1.37 onoe struct ieee80211com *ic = &sc->sc_ic;
939 1.37 onoe int rate;
940 1.1 sommerfe
941 1.37 onoe imr->ifm_status = IFM_AVALID;
942 1.37 onoe if (ic->ic_state == IEEE80211_S_RUN)
943 1.37 onoe imr->ifm_status |= IFM_ACTIVE;
944 1.37 onoe imr->ifm_active = IFM_IEEE80211;
945 1.37 onoe if (ic->ic_state == IEEE80211_S_RUN)
946 1.47 onoe rate = ic->ic_bss.ni_rates[ic->ic_bss.ni_txrate] &
947 1.37 onoe IEEE80211_RATE_VAL;
948 1.37 onoe else {
949 1.37 onoe if (ic->ic_fixed_rate == -1)
950 1.37 onoe rate = 0;
951 1.37 onoe else
952 1.37 onoe rate = ic->ic_sup_rates[ic->ic_fixed_rate] &
953 1.37 onoe IEEE80211_RATE_VAL;
954 1.10 onoe }
955 1.47 onoe imr->ifm_active |= ieee80211_rate2media(rate, ic->ic_phytype);
956 1.47 onoe switch (ic->ic_opmode) {
957 1.47 onoe case IEEE80211_M_STA:
958 1.47 onoe break;
959 1.47 onoe case IEEE80211_M_ADHOC:
960 1.37 onoe if (sc->sc_adhoc_ap)
961 1.37 onoe imr->ifm_active |= IFM_FLAG0;
962 1.37 onoe else {
963 1.37 onoe imr->ifm_active |= IFM_IEEE80211_ADHOC;
964 1.37 onoe if (sc->sc_no_bssid)
965 1.37 onoe imr->ifm_active |= IFM_FLAG0;
966 1.18 onoe }
967 1.47 onoe break;
968 1.47 onoe case IEEE80211_M_HOSTAP:
969 1.47 onoe imr->ifm_active |= IFM_IEEE80211_HOSTAP;
970 1.47 onoe break;
971 1.18 onoe }
972 1.37 onoe }
973 1.37 onoe
974 1.37 onoe static int
975 1.37 onoe awi_mode_init(struct awi_softc *sc)
976 1.37 onoe {
977 1.37 onoe struct ifnet *ifp = &sc->sc_ic.ic_if;
978 1.37 onoe int n, error;
979 1.37 onoe struct ether_multi *enm;
980 1.37 onoe struct ether_multistep step;
981 1.37 onoe
982 1.37 onoe /* reinitialize muticast filter */
983 1.37 onoe n = 0;
984 1.37 onoe sc->sc_mib_local.Accept_All_Multicast_Dis = 0;
985 1.47 onoe if (sc->sc_ic.ic_opmode != IEEE80211_M_HOSTAP &&
986 1.46 onoe (ifp->if_flags & IFF_PROMISC)) {
987 1.37 onoe sc->sc_mib_mac.aPromiscuous_Enable = 1;
988 1.37 onoe goto set_mib;
989 1.37 onoe }
990 1.37 onoe sc->sc_mib_mac.aPromiscuous_Enable = 0;
991 1.37 onoe ETHER_FIRST_MULTI(step, &sc->sc_ic.ic_ec, enm);
992 1.37 onoe while (enm != NULL) {
993 1.37 onoe if (n == AWI_GROUP_ADDR_SIZE ||
994 1.47 onoe !IEEE80211_ADDR_EQ(enm->enm_addrlo, enm->enm_addrhi))
995 1.37 onoe goto set_mib;
996 1.47 onoe IEEE80211_ADDR_COPY(sc->sc_mib_addr.aGroup_Addresses[n],
997 1.47 onoe enm->enm_addrlo);
998 1.37 onoe n++;
999 1.37 onoe ETHER_NEXT_MULTI(step, enm);
1000 1.37 onoe }
1001 1.37 onoe for (; n < AWI_GROUP_ADDR_SIZE; n++)
1002 1.47 onoe memset(sc->sc_mib_addr.aGroup_Addresses[n], 0,
1003 1.47 onoe IEEE80211_ADDR_LEN);
1004 1.37 onoe sc->sc_mib_local.Accept_All_Multicast_Dis = 1;
1005 1.37 onoe
1006 1.37 onoe set_mib:
1007 1.37 onoe if (sc->sc_mib_local.Accept_All_Multicast_Dis)
1008 1.37 onoe ifp->if_flags &= ~IFF_ALLMULTI;
1009 1.37 onoe else
1010 1.37 onoe ifp->if_flags |= IFF_ALLMULTI;
1011 1.37 onoe sc->sc_mib_mgt.Wep_Required =
1012 1.43 onoe (sc->sc_ic.ic_flags & IEEE80211_F_WEPON) ? AWI_WEP_ON : AWI_WEP_OFF;
1013 1.37 onoe
1014 1.37 onoe if ((error = awi_mib(sc, AWI_CMD_SET_MIB, AWI_MIB_LOCAL, AWI_WAIT)) ||
1015 1.37 onoe (error = awi_mib(sc, AWI_CMD_SET_MIB, AWI_MIB_ADDR, AWI_WAIT)) ||
1016 1.37 onoe (error = awi_mib(sc, AWI_CMD_SET_MIB, AWI_MIB_MAC, AWI_WAIT)) ||
1017 1.37 onoe (error = awi_mib(sc, AWI_CMD_SET_MIB, AWI_MIB_MGT, AWI_WAIT)) ||
1018 1.37 onoe (error = awi_mib(sc, AWI_CMD_SET_MIB, AWI_MIB_PHY, AWI_WAIT))) {
1019 1.37 onoe DPRINTF(("awi_mode_init: MIB set failed: %d\n", error));
1020 1.37 onoe return error;
1021 1.37 onoe }
1022 1.37 onoe return 0;
1023 1.1 sommerfe }
1024 1.9 sommerfe
1025 1.10 onoe static void
1026 1.37 onoe awi_rx_int(struct awi_softc *sc)
1027 1.9 sommerfe {
1028 1.37 onoe struct ifnet *ifp = &sc->sc_ic.ic_if;
1029 1.10 onoe u_int8_t state, rate, rssi;
1030 1.10 onoe u_int16_t len;
1031 1.43 onoe u_int32_t frame, next, rstamp, rxoff;
1032 1.10 onoe struct mbuf *m;
1033 1.10 onoe
1034 1.10 onoe rxoff = sc->sc_rxdoff;
1035 1.10 onoe for (;;) {
1036 1.10 onoe state = awi_read_1(sc, rxoff + AWI_RXD_HOST_DESC_STATE);
1037 1.10 onoe if (state & AWI_RXD_ST_OWN)
1038 1.10 onoe break;
1039 1.10 onoe if (!(state & AWI_RXD_ST_CONSUMED)) {
1040 1.43 onoe if (sc->sc_substate != AWI_ST_NONE)
1041 1.43 onoe goto rx_next;
1042 1.37 onoe if (state & AWI_RXD_ST_RXERROR) {
1043 1.37 onoe ifp->if_ierrors++;
1044 1.37 onoe goto rx_next;
1045 1.37 onoe }
1046 1.37 onoe len = awi_read_2(sc, rxoff + AWI_RXD_LEN);
1047 1.37 onoe rate = awi_read_1(sc, rxoff + AWI_RXD_RATE);
1048 1.37 onoe rssi = awi_read_1(sc, rxoff + AWI_RXD_RSSI);
1049 1.37 onoe frame = awi_read_4(sc, rxoff + AWI_RXD_START_FRAME) &
1050 1.37 onoe 0x7fff;
1051 1.43 onoe rstamp = awi_read_4(sc, rxoff + AWI_RXD_LOCALTIME);
1052 1.37 onoe m = awi_devget(sc, frame, len);
1053 1.37 onoe if (m == NULL) {
1054 1.37 onoe ifp->if_ierrors++;
1055 1.37 onoe goto rx_next;
1056 1.37 onoe }
1057 1.37 onoe if (state & AWI_RXD_ST_LF) {
1058 1.37 onoe /* TODO check my bss */
1059 1.37 onoe if (!(sc->sc_ic.ic_flags & IEEE80211_F_SIBSS) &&
1060 1.37 onoe sc->sc_ic.ic_state == IEEE80211_S_RUN) {
1061 1.37 onoe sc->sc_rx_timer = 10;
1062 1.37 onoe ifp->if_timer = 1;
1063 1.37 onoe }
1064 1.37 onoe if ((ifp->if_flags & IFF_DEBUG) &&
1065 1.37 onoe (ifp->if_flags & IFF_LINK2))
1066 1.37 onoe ieee80211_dump_pkt(m->m_data, m->m_len,
1067 1.37 onoe rate / 5, rssi);
1068 1.37 onoe if ((ifp->if_flags & IFF_LINK0) ||
1069 1.37 onoe sc->sc_adhoc_ap)
1070 1.37 onoe m = awi_ether_modcap(sc, m);
1071 1.37 onoe if (m == NULL)
1072 1.37 onoe ifp->if_ierrors++;
1073 1.10 onoe else
1074 1.43 onoe ieee80211_input(ifp, m, rssi, rstamp);
1075 1.37 onoe } else
1076 1.37 onoe sc->sc_rxpend = m;
1077 1.37 onoe rx_next:
1078 1.10 onoe state |= AWI_RXD_ST_CONSUMED;
1079 1.10 onoe awi_write_1(sc, rxoff + AWI_RXD_HOST_DESC_STATE, state);
1080 1.10 onoe }
1081 1.37 onoe next = awi_read_4(sc, rxoff + AWI_RXD_NEXT);
1082 1.10 onoe if (next & AWI_RXD_NEXT_LAST)
1083 1.10 onoe break;
1084 1.37 onoe /* make sure the next pointer is correct */
1085 1.37 onoe if (next != awi_read_4(sc, rxoff + AWI_RXD_NEXT))
1086 1.37 onoe break;
1087 1.37 onoe state |= AWI_RXD_ST_OWN;
1088 1.37 onoe awi_write_1(sc, rxoff + AWI_RXD_HOST_DESC_STATE, state);
1089 1.37 onoe rxoff = next & 0x7fff;
1090 1.37 onoe }
1091 1.37 onoe sc->sc_rxdoff = rxoff;
1092 1.37 onoe }
1093 1.37 onoe
1094 1.37 onoe static void
1095 1.37 onoe awi_tx_int(struct awi_softc *sc)
1096 1.37 onoe {
1097 1.37 onoe struct ifnet *ifp = &sc->sc_ic.ic_if;
1098 1.37 onoe u_int8_t flags;
1099 1.37 onoe
1100 1.37 onoe while (sc->sc_txdone != sc->sc_txnext) {
1101 1.37 onoe flags = awi_read_1(sc, sc->sc_txdone + AWI_TXD_STATE);
1102 1.37 onoe if ((flags & AWI_TXD_ST_OWN) || !(flags & AWI_TXD_ST_DONE))
1103 1.10 onoe break;
1104 1.37 onoe if (flags & AWI_TXD_ST_ERROR)
1105 1.37 onoe ifp->if_oerrors++;
1106 1.37 onoe sc->sc_txdone = awi_read_4(sc, sc->sc_txdone + AWI_TXD_NEXT) &
1107 1.37 onoe 0x7fff;
1108 1.10 onoe }
1109 1.37 onoe DPRINTF2(("awi_txint: txdone %d txnext %d txbase %d txend %d\n",
1110 1.37 onoe sc->sc_txdone, sc->sc_txnext, sc->sc_txbase, sc->sc_txend));
1111 1.37 onoe sc->sc_tx_timer = 0;
1112 1.37 onoe ifp->if_flags &= ~IFF_OACTIVE;
1113 1.37 onoe awi_start(ifp);
1114 1.9 sommerfe }
1115 1.9 sommerfe
1116 1.18 onoe static struct mbuf *
1117 1.37 onoe awi_devget(struct awi_softc *sc, u_int32_t off, u_int16_t len)
1118 1.1 sommerfe {
1119 1.37 onoe struct ifnet *ifp = &sc->sc_ic.ic_if;
1120 1.10 onoe struct mbuf *m;
1121 1.18 onoe struct mbuf *top, **mp;
1122 1.10 onoe u_int tlen;
1123 1.10 onoe
1124 1.10 onoe top = sc->sc_rxpend;
1125 1.18 onoe mp = ⊤
1126 1.10 onoe if (top != NULL) {
1127 1.10 onoe sc->sc_rxpend = NULL;
1128 1.10 onoe top->m_pkthdr.len += len;
1129 1.20 onoe m = top;
1130 1.18 onoe while (*mp != NULL) {
1131 1.18 onoe m = *mp;
1132 1.10 onoe mp = &m->m_next;
1133 1.18 onoe }
1134 1.10 onoe if (m->m_flags & M_EXT)
1135 1.10 onoe tlen = m->m_ext.ext_size;
1136 1.10 onoe else if (m->m_flags & M_PKTHDR)
1137 1.10 onoe tlen = MHLEN;
1138 1.10 onoe else
1139 1.10 onoe tlen = MLEN;
1140 1.10 onoe tlen -= m->m_len;
1141 1.10 onoe if (tlen > len)
1142 1.10 onoe tlen = len;
1143 1.10 onoe awi_read_bytes(sc, off, mtod(m, u_int8_t *) + m->m_len, tlen);
1144 1.10 onoe off += tlen;
1145 1.10 onoe len -= tlen;
1146 1.10 onoe }
1147 1.10 onoe
1148 1.10 onoe while (len > 0) {
1149 1.10 onoe if (top == NULL) {
1150 1.10 onoe MGETHDR(m, M_DONTWAIT, MT_DATA);
1151 1.10 onoe if (m == NULL)
1152 1.10 onoe return NULL;
1153 1.37 onoe m->m_pkthdr.rcvif = ifp;
1154 1.10 onoe m->m_pkthdr.len = len;
1155 1.10 onoe m->m_len = MHLEN;
1156 1.37 onoe m->m_flags |= M_HASFCS;
1157 1.10 onoe } else {
1158 1.10 onoe MGET(m, M_DONTWAIT, MT_DATA);
1159 1.10 onoe if (m == NULL) {
1160 1.10 onoe m_freem(top);
1161 1.10 onoe return NULL;
1162 1.10 onoe }
1163 1.10 onoe m->m_len = MLEN;
1164 1.10 onoe }
1165 1.10 onoe if (len >= MINCLSIZE) {
1166 1.10 onoe MCLGET(m, M_DONTWAIT);
1167 1.10 onoe if (m->m_flags & M_EXT)
1168 1.10 onoe m->m_len = m->m_ext.ext_size;
1169 1.10 onoe }
1170 1.20 onoe if (top == NULL) {
1171 1.20 onoe int hdrlen = sizeof(struct ieee80211_frame) +
1172 1.37 onoe sizeof(struct llc);
1173 1.20 onoe caddr_t newdata = (caddr_t)
1174 1.20 onoe ALIGN(m->m_data + hdrlen) - hdrlen;
1175 1.20 onoe m->m_len -= newdata - m->m_data;
1176 1.20 onoe m->m_data = newdata;
1177 1.20 onoe }
1178 1.10 onoe if (m->m_len > len)
1179 1.10 onoe m->m_len = len;
1180 1.10 onoe awi_read_bytes(sc, off, mtod(m, u_int8_t *), m->m_len);
1181 1.10 onoe off += m->m_len;
1182 1.10 onoe len -= m->m_len;
1183 1.10 onoe *mp = m;
1184 1.10 onoe mp = &m->m_next;
1185 1.10 onoe }
1186 1.10 onoe return top;
1187 1.1 sommerfe }
1188 1.1 sommerfe
1189 1.10 onoe /*
1190 1.10 onoe * Initialize hardware and start firmware to accept commands.
1191 1.10 onoe * Called everytime after power on firmware.
1192 1.10 onoe */
1193 1.10 onoe
1194 1.10 onoe static int
1195 1.37 onoe awi_hw_init(struct awi_softc *sc)
1196 1.1 sommerfe {
1197 1.10 onoe u_int8_t status;
1198 1.10 onoe u_int16_t intmask;
1199 1.10 onoe int i, error;
1200 1.1 sommerfe
1201 1.15 onoe sc->sc_enab_intr = 0;
1202 1.20 onoe sc->sc_invalid = 0; /* XXX: really? */
1203 1.10 onoe awi_drvstate(sc, AWI_DRV_RESET);
1204 1.1 sommerfe
1205 1.10 onoe /* reset firmware */
1206 1.10 onoe am79c930_gcr_setbits(&sc->sc_chip, AM79C930_GCR_CORESET);
1207 1.10 onoe DELAY(100);
1208 1.10 onoe awi_write_1(sc, AWI_SELFTEST, 0);
1209 1.20 onoe awi_write_1(sc, AWI_CMD, 0);
1210 1.20 onoe awi_write_1(sc, AWI_BANNER, 0);
1211 1.10 onoe am79c930_gcr_clearbits(&sc->sc_chip, AM79C930_GCR_CORESET);
1212 1.10 onoe DELAY(100);
1213 1.10 onoe
1214 1.10 onoe /* wait for selftest completion */
1215 1.10 onoe for (i = 0; ; i++) {
1216 1.10 onoe if (i >= AWI_SELFTEST_TIMEOUT*hz/1000) {
1217 1.10 onoe printf("%s: failed to complete selftest (timeout)\n",
1218 1.10 onoe sc->sc_dev.dv_xname);
1219 1.10 onoe return ENXIO;
1220 1.10 onoe }
1221 1.10 onoe status = awi_read_1(sc, AWI_SELFTEST);
1222 1.10 onoe if ((status & 0xf0) == 0xf0)
1223 1.10 onoe break;
1224 1.10 onoe if (sc->sc_cansleep) {
1225 1.10 onoe sc->sc_sleep_cnt++;
1226 1.10 onoe (void)tsleep(sc, PWAIT, "awitst", 1);
1227 1.10 onoe sc->sc_sleep_cnt--;
1228 1.10 onoe } else {
1229 1.10 onoe DELAY(1000*1000/hz);
1230 1.10 onoe }
1231 1.10 onoe }
1232 1.10 onoe if (status != AWI_SELFTEST_PASSED) {
1233 1.10 onoe printf("%s: failed to complete selftest (code %x)\n",
1234 1.10 onoe sc->sc_dev.dv_xname, status);
1235 1.10 onoe return ENXIO;
1236 1.10 onoe }
1237 1.1 sommerfe
1238 1.10 onoe /* check banner to confirm firmware write it */
1239 1.18 onoe awi_read_bytes(sc, AWI_BANNER, sc->sc_banner, AWI_BANNER_LEN);
1240 1.18 onoe if (memcmp(sc->sc_banner, "PCnetMobile:", 12) != 0) {
1241 1.10 onoe printf("%s: failed to complete selftest (bad banner)\n",
1242 1.10 onoe sc->sc_dev.dv_xname);
1243 1.10 onoe for (i = 0; i < AWI_BANNER_LEN; i++)
1244 1.18 onoe printf("%s%02x", i ? ":" : "\t", sc->sc_banner[i]);
1245 1.10 onoe printf("\n");
1246 1.10 onoe return ENXIO;
1247 1.10 onoe }
1248 1.1 sommerfe
1249 1.10 onoe /* initializing interrupt */
1250 1.15 onoe sc->sc_enab_intr = 1;
1251 1.10 onoe error = awi_intr_lock(sc);
1252 1.10 onoe if (error)
1253 1.10 onoe return error;
1254 1.10 onoe intmask = AWI_INT_GROGGY | AWI_INT_SCAN_CMPLT |
1255 1.10 onoe AWI_INT_TX | AWI_INT_RX | AWI_INT_CMD;
1256 1.10 onoe awi_write_1(sc, AWI_INTMASK, ~intmask & 0xff);
1257 1.10 onoe awi_write_1(sc, AWI_INTMASK2, 0);
1258 1.10 onoe awi_write_1(sc, AWI_INTSTAT, 0);
1259 1.10 onoe awi_write_1(sc, AWI_INTSTAT2, 0);
1260 1.10 onoe awi_intr_unlock(sc);
1261 1.10 onoe am79c930_gcr_setbits(&sc->sc_chip, AM79C930_GCR_ENECINT);
1262 1.1 sommerfe
1263 1.36 wiz /* issuing interface test command */
1264 1.37 onoe error = awi_cmd(sc, AWI_CMD_NOP, AWI_WAIT);
1265 1.10 onoe if (error) {
1266 1.10 onoe printf("%s: failed to complete selftest", sc->sc_dev.dv_xname);
1267 1.20 onoe if (error == ENXIO)
1268 1.20 onoe printf(" (no hardware)\n");
1269 1.20 onoe else if (error != EWOULDBLOCK)
1270 1.10 onoe printf(" (error %d)\n", error);
1271 1.10 onoe else if (sc->sc_cansleep)
1272 1.10 onoe printf(" (lost interrupt)\n");
1273 1.10 onoe else
1274 1.10 onoe printf(" (command timeout)\n");
1275 1.46 onoe return error;
1276 1.10 onoe }
1277 1.46 onoe
1278 1.46 onoe /* Initialize VBM */
1279 1.46 onoe awi_write_1(sc, AWI_VBM_OFFSET, 0);
1280 1.46 onoe awi_write_1(sc, AWI_VBM_LENGTH, 1);
1281 1.46 onoe awi_write_1(sc, AWI_VBM_BITMAP, 0);
1282 1.46 onoe return 0;
1283 1.10 onoe }
1284 1.1 sommerfe
1285 1.10 onoe /*
1286 1.10 onoe * Extract the factory default MIB value from firmware and assign the driver
1287 1.10 onoe * default value.
1288 1.10 onoe * Called once at attaching the interface.
1289 1.10 onoe */
1290 1.1 sommerfe
1291 1.37 onoe static int
1292 1.37 onoe awi_init_mibs(struct awi_softc *sc)
1293 1.1 sommerfe {
1294 1.37 onoe int i, error;
1295 1.37 onoe struct awi_chanset *cs;
1296 1.1 sommerfe
1297 1.37 onoe if ((error = awi_mib(sc, AWI_CMD_GET_MIB, AWI_MIB_LOCAL, AWI_WAIT)) ||
1298 1.37 onoe (error = awi_mib(sc, AWI_CMD_GET_MIB, AWI_MIB_ADDR, AWI_WAIT)) ||
1299 1.37 onoe (error = awi_mib(sc, AWI_CMD_GET_MIB, AWI_MIB_MAC, AWI_WAIT)) ||
1300 1.37 onoe (error = awi_mib(sc, AWI_CMD_GET_MIB, AWI_MIB_MGT, AWI_WAIT)) ||
1301 1.37 onoe (error = awi_mib(sc, AWI_CMD_GET_MIB, AWI_MIB_PHY, AWI_WAIT))) {
1302 1.37 onoe printf("%s: failed to get default mib value (error %d)\n",
1303 1.37 onoe sc->sc_dev.dv_xname, error);
1304 1.37 onoe return error;
1305 1.37 onoe }
1306 1.10 onoe
1307 1.37 onoe memset(&sc->sc_ic.ic_chan_avail, 0, sizeof(sc->sc_ic.ic_chan_avail));
1308 1.37 onoe for (cs = awi_chanset; ; cs++) {
1309 1.37 onoe if (cs->cs_type == 0) {
1310 1.37 onoe printf("%s: failed to set available channel\n",
1311 1.37 onoe sc->sc_dev.dv_xname);
1312 1.37 onoe return ENXIO;
1313 1.37 onoe }
1314 1.37 onoe if (cs->cs_type == sc->sc_mib_phy.IEEE_PHY_Type &&
1315 1.37 onoe cs->cs_region == sc->sc_mib_phy.aCurrent_Reg_Domain)
1316 1.37 onoe break;
1317 1.37 onoe }
1318 1.39 onoe if (sc->sc_mib_phy.IEEE_PHY_Type == AWI_PHY_TYPE_FH) {
1319 1.39 onoe for (i = cs->cs_min; i <= cs->cs_max; i++) {
1320 1.39 onoe setbit(sc->sc_ic.ic_chan_avail,
1321 1.39 onoe IEEE80211_FH_CHAN(i % 3 + 1, i));
1322 1.39 onoe /*
1323 1.39 onoe * According to the IEEE 802.11 specification,
1324 1.39 onoe * hop pattern parameter for FH phy should be
1325 1.39 onoe * incremented by 3 for given hop chanset, i.e.,
1326 1.39 onoe * the chanset parameter is calculated for given
1327 1.39 onoe * hop patter. However, BayStack 650 Access Points
1328 1.39 onoe * apparently use fixed hop chanset parameter value
1329 1.39 onoe * 1 for any hop pattern. So we also try this
1330 1.39 onoe * combination of hop chanset and pattern.
1331 1.39 onoe */
1332 1.39 onoe setbit(sc->sc_ic.ic_chan_avail,
1333 1.39 onoe IEEE80211_FH_CHAN(1, i));
1334 1.39 onoe }
1335 1.39 onoe } else {
1336 1.39 onoe for (i = cs->cs_min; i <= cs->cs_max; i++)
1337 1.39 onoe setbit(sc->sc_ic.ic_chan_avail, i);
1338 1.39 onoe }
1339 1.37 onoe sc->sc_cur_chan = cs->cs_def;
1340 1.1 sommerfe
1341 1.37 onoe sc->sc_mib_local.Fragmentation_Dis = 1;
1342 1.46 onoe sc->sc_mib_local.Add_PLCP_Dis = 0;
1343 1.46 onoe sc->sc_mib_local.MAC_Hdr_Prsv = 1;
1344 1.46 onoe sc->sc_mib_local.Rx_Mgmt_Que_En = 0;
1345 1.46 onoe sc->sc_mib_local.Re_Assembly_Dis = 1;
1346 1.46 onoe sc->sc_mib_local.Strip_PLCP_Dis = 0;
1347 1.46 onoe sc->sc_mib_local.Power_Saving_Mode_Dis = 1;
1348 1.37 onoe sc->sc_mib_local.Accept_All_Multicast_Dis = 1;
1349 1.46 onoe sc->sc_mib_local.Check_Seq_Cntl_Dis = 1;
1350 1.46 onoe sc->sc_mib_local.Flush_CFP_Queue_On_CF_End = 0;
1351 1.46 onoe sc->sc_mib_local.Network_Mode = 1;
1352 1.46 onoe sc->sc_mib_local.PWD_Lvl = 0;
1353 1.46 onoe sc->sc_mib_local.CFP_Mode = 0;
1354 1.1 sommerfe
1355 1.37 onoe /* allocate buffers */
1356 1.37 onoe sc->sc_txbase = AWI_BUFFERS;
1357 1.37 onoe sc->sc_txend = sc->sc_txbase +
1358 1.37 onoe (AWI_TXD_SIZE + sizeof(struct ieee80211_frame) +
1359 1.37 onoe sizeof(struct ether_header) + ETHERMTU) * AWI_NTXBUFS;
1360 1.37 onoe LE_WRITE_4(&sc->sc_mib_local.Tx_Buffer_Offset, sc->sc_txbase);
1361 1.37 onoe LE_WRITE_4(&sc->sc_mib_local.Tx_Buffer_Size,
1362 1.37 onoe sc->sc_txend - sc->sc_txbase);
1363 1.37 onoe LE_WRITE_4(&sc->sc_mib_local.Rx_Buffer_Offset, sc->sc_txend);
1364 1.37 onoe LE_WRITE_4(&sc->sc_mib_local.Rx_Buffer_Size,
1365 1.37 onoe AWI_BUFFERS_END - sc->sc_txend);
1366 1.37 onoe sc->sc_mib_local.Acting_as_AP = 0;
1367 1.46 onoe sc->sc_mib_local.Fill_CFP = 0;
1368 1.46 onoe
1369 1.46 onoe memset(&sc->sc_mib_mac.aDesired_ESS_ID, 0, AWI_ESS_ID_SIZE);
1370 1.46 onoe sc->sc_mib_mac.aDesired_ESS_ID[0] = IEEE80211_ELEMID_SSID;
1371 1.46 onoe
1372 1.46 onoe sc->sc_mib_mgt.aPower_Mgt_Mode = 0;
1373 1.46 onoe sc->sc_mib_mgt.aDTIM_Period = 1;
1374 1.46 onoe LE_WRITE_2(&sc->sc_mib_mgt.aATIM_Window, 0);
1375 1.37 onoe return 0;
1376 1.1 sommerfe }
1377 1.1 sommerfe
1378 1.37 onoe static int
1379 1.37 onoe awi_chan_check(void *arg, u_char *chanreq)
1380 1.1 sommerfe {
1381 1.37 onoe struct awi_softc *sc = arg;
1382 1.37 onoe int i;
1383 1.37 onoe struct awi_chanset *cs;
1384 1.37 onoe u_char chanlist[(IEEE80211_CHAN_MAX+1)/NBBY];
1385 1.10 onoe
1386 1.37 onoe for (cs = awi_chanset; cs->cs_type != 0; cs++) {
1387 1.37 onoe if (cs->cs_type != sc->sc_mib_phy.IEEE_PHY_Type)
1388 1.37 onoe continue;
1389 1.37 onoe memset(chanlist, 0, sizeof(chanlist));
1390 1.37 onoe for (i = 0; ; i++) {
1391 1.37 onoe if (i == IEEE80211_CHAN_MAX) {
1392 1.37 onoe sc->sc_mib_phy.aCurrent_Reg_Domain =
1393 1.37 onoe cs->cs_region;
1394 1.37 onoe memcpy(sc->sc_ic.ic_chan_avail, chanlist,
1395 1.37 onoe sizeof(sc->sc_ic.ic_chan_avail));
1396 1.47 onoe sc->sc_ic.ic_bss.ni_chan = cs->cs_def;
1397 1.37 onoe sc->sc_cur_chan = cs->cs_def;
1398 1.37 onoe return 0;
1399 1.37 onoe }
1400 1.37 onoe if (i >= cs->cs_min && i <= cs->cs_max)
1401 1.37 onoe setbit(chanlist, i);
1402 1.37 onoe else if (isset(chanreq, i))
1403 1.10 onoe break;
1404 1.10 onoe }
1405 1.10 onoe }
1406 1.37 onoe return EINVAL;
1407 1.1 sommerfe }
1408 1.1 sommerfe
1409 1.10 onoe static int
1410 1.37 onoe awi_mib(struct awi_softc *sc, u_int8_t cmd, u_int8_t mib, int wflag)
1411 1.1 sommerfe {
1412 1.10 onoe int error;
1413 1.10 onoe u_int8_t size, *ptr;
1414 1.1 sommerfe
1415 1.10 onoe switch (mib) {
1416 1.10 onoe case AWI_MIB_LOCAL:
1417 1.10 onoe ptr = (u_int8_t *)&sc->sc_mib_local;
1418 1.10 onoe size = sizeof(sc->sc_mib_local);
1419 1.10 onoe break;
1420 1.10 onoe case AWI_MIB_ADDR:
1421 1.10 onoe ptr = (u_int8_t *)&sc->sc_mib_addr;
1422 1.10 onoe size = sizeof(sc->sc_mib_addr);
1423 1.10 onoe break;
1424 1.10 onoe case AWI_MIB_MAC:
1425 1.10 onoe ptr = (u_int8_t *)&sc->sc_mib_mac;
1426 1.10 onoe size = sizeof(sc->sc_mib_mac);
1427 1.10 onoe break;
1428 1.10 onoe case AWI_MIB_STAT:
1429 1.10 onoe ptr = (u_int8_t *)&sc->sc_mib_stat;
1430 1.10 onoe size = sizeof(sc->sc_mib_stat);
1431 1.10 onoe break;
1432 1.10 onoe case AWI_MIB_MGT:
1433 1.10 onoe ptr = (u_int8_t *)&sc->sc_mib_mgt;
1434 1.10 onoe size = sizeof(sc->sc_mib_mgt);
1435 1.10 onoe break;
1436 1.10 onoe case AWI_MIB_PHY:
1437 1.10 onoe ptr = (u_int8_t *)&sc->sc_mib_phy;
1438 1.10 onoe size = sizeof(sc->sc_mib_phy);
1439 1.10 onoe break;
1440 1.10 onoe default:
1441 1.10 onoe return EINVAL;
1442 1.1 sommerfe }
1443 1.10 onoe if (sc->sc_cmd_inprog) {
1444 1.37 onoe if ((error = awi_cmd_wait(sc)) != 0) {
1445 1.20 onoe if (error == EWOULDBLOCK)
1446 1.37 onoe DPRINTF(("awi_mib: cmd %d inprog",
1447 1.37 onoe sc->sc_cmd_inprog));
1448 1.10 onoe return error;
1449 1.10 onoe }
1450 1.10 onoe }
1451 1.20 onoe sc->sc_cmd_inprog = cmd;
1452 1.10 onoe if (cmd == AWI_CMD_SET_MIB)
1453 1.37 onoe awi_write_bytes(sc, AWI_CA_MIB_DATA, ptr, size);
1454 1.37 onoe awi_write_1(sc, AWI_CA_MIB_TYPE, mib);
1455 1.37 onoe awi_write_1(sc, AWI_CA_MIB_SIZE, size);
1456 1.37 onoe awi_write_1(sc, AWI_CA_MIB_INDEX, 0);
1457 1.37 onoe if ((error = awi_cmd(sc, cmd, wflag)) != 0)
1458 1.10 onoe return error;
1459 1.10 onoe if (cmd == AWI_CMD_GET_MIB) {
1460 1.37 onoe awi_read_bytes(sc, AWI_CA_MIB_DATA, ptr, size);
1461 1.10 onoe #ifdef AWI_DEBUG
1462 1.37 onoe if (awi_debug) {
1463 1.10 onoe int i;
1464 1.1 sommerfe
1465 1.10 onoe printf("awi_mib: #%d:", mib);
1466 1.10 onoe for (i = 0; i < size; i++)
1467 1.10 onoe printf(" %02x", ptr[i]);
1468 1.10 onoe printf("\n");
1469 1.10 onoe }
1470 1.1 sommerfe #endif
1471 1.10 onoe }
1472 1.10 onoe return 0;
1473 1.1 sommerfe }
1474 1.1 sommerfe
1475 1.10 onoe static int
1476 1.37 onoe awi_cmd(struct awi_softc *sc, u_int8_t cmd, int wflag)
1477 1.1 sommerfe {
1478 1.10 onoe u_int8_t status;
1479 1.10 onoe int error = 0;
1480 1.37 onoe #ifdef AWI_DEBUG
1481 1.37 onoe static const char *cmdname[] = {
1482 1.37 onoe "IDLE", "NOP", "SET_MIB", "INIT_TX", "FLUSH_TX", "INIT_RX",
1483 1.37 onoe "KILL_RX", "SLEEP", "WAKE", "GET_MIB", "SCAN", "SYNC", "RESUME"
1484 1.37 onoe };
1485 1.37 onoe #endif
1486 1.10 onoe
1487 1.37 onoe #ifdef AWI_DEBUG
1488 1.37 onoe if (awi_debug > 1) {
1489 1.37 onoe if (cmd >= sizeof(cmdname)/sizeof(cmdname[0]))
1490 1.37 onoe printf("awi_cmd: #%d", cmd);
1491 1.37 onoe else
1492 1.37 onoe printf("awi_cmd: %s", cmdname[cmd]);
1493 1.37 onoe printf(" %s\n", wflag == AWI_NOWAIT ? "nowait" : "wait");
1494 1.37 onoe }
1495 1.37 onoe #endif
1496 1.20 onoe sc->sc_cmd_inprog = cmd;
1497 1.10 onoe awi_write_1(sc, AWI_CMD_STATUS, AWI_STAT_IDLE);
1498 1.10 onoe awi_write_1(sc, AWI_CMD, cmd);
1499 1.37 onoe if (wflag == AWI_NOWAIT)
1500 1.37 onoe return EINPROGRESS;
1501 1.37 onoe if ((error = awi_cmd_wait(sc)) != 0)
1502 1.10 onoe return error;
1503 1.10 onoe status = awi_read_1(sc, AWI_CMD_STATUS);
1504 1.10 onoe awi_write_1(sc, AWI_CMD, 0);
1505 1.10 onoe switch (status) {
1506 1.10 onoe case AWI_STAT_OK:
1507 1.10 onoe break;
1508 1.10 onoe case AWI_STAT_BADPARM:
1509 1.10 onoe return EINVAL;
1510 1.10 onoe default:
1511 1.10 onoe printf("%s: command %d failed %x\n",
1512 1.10 onoe sc->sc_dev.dv_xname, cmd, status);
1513 1.10 onoe return ENXIO;
1514 1.10 onoe }
1515 1.10 onoe return 0;
1516 1.1 sommerfe }
1517 1.1 sommerfe
1518 1.37 onoe static int
1519 1.37 onoe awi_cmd_wait(struct awi_softc *sc)
1520 1.37 onoe {
1521 1.37 onoe int i, error = 0;
1522 1.37 onoe
1523 1.37 onoe i = 0;
1524 1.37 onoe while (sc->sc_cmd_inprog) {
1525 1.37 onoe if (sc->sc_invalid)
1526 1.37 onoe return ENXIO;
1527 1.37 onoe if (awi_read_1(sc, AWI_CMD) != sc->sc_cmd_inprog) {
1528 1.37 onoe printf("%s: failed to access hardware\n",
1529 1.37 onoe sc->sc_dev.dv_xname);
1530 1.37 onoe sc->sc_invalid = 1;
1531 1.37 onoe return ENXIO;
1532 1.37 onoe }
1533 1.37 onoe if (sc->sc_cansleep) {
1534 1.37 onoe sc->sc_sleep_cnt++;
1535 1.37 onoe error = tsleep(sc, PWAIT, "awicmd",
1536 1.37 onoe AWI_CMD_TIMEOUT*hz/1000);
1537 1.37 onoe sc->sc_sleep_cnt--;
1538 1.37 onoe } else {
1539 1.37 onoe if (awi_read_1(sc, AWI_CMD_STATUS) != AWI_STAT_IDLE) {
1540 1.37 onoe awi_cmd_done(sc);
1541 1.37 onoe break;
1542 1.37 onoe }
1543 1.37 onoe if (i++ >= AWI_CMD_TIMEOUT*1000/10)
1544 1.37 onoe error = EWOULDBLOCK;
1545 1.37 onoe else
1546 1.37 onoe DELAY(10);
1547 1.37 onoe }
1548 1.37 onoe if (error)
1549 1.37 onoe break;
1550 1.37 onoe }
1551 1.37 onoe if (error) {
1552 1.37 onoe DPRINTF(("awi_cmd_wait: cmd 0x%x, error %d\n",
1553 1.37 onoe sc->sc_cmd_inprog, error));
1554 1.37 onoe }
1555 1.37 onoe return error;
1556 1.37 onoe }
1557 1.37 onoe
1558 1.10 onoe static void
1559 1.37 onoe awi_cmd_done(struct awi_softc *sc)
1560 1.1 sommerfe {
1561 1.10 onoe u_int8_t cmd, status;
1562 1.10 onoe
1563 1.10 onoe status = awi_read_1(sc, AWI_CMD_STATUS);
1564 1.10 onoe if (status == AWI_STAT_IDLE)
1565 1.10 onoe return; /* stray interrupt */
1566 1.10 onoe
1567 1.20 onoe cmd = sc->sc_cmd_inprog;
1568 1.10 onoe sc->sc_cmd_inprog = 0;
1569 1.37 onoe wakeup(sc);
1570 1.10 onoe awi_write_1(sc, AWI_CMD, 0);
1571 1.10 onoe
1572 1.10 onoe if (status != AWI_STAT_OK) {
1573 1.10 onoe printf("%s: command %d failed %x\n",
1574 1.10 onoe sc->sc_dev.dv_xname, cmd, status);
1575 1.37 onoe sc->sc_substate = AWI_ST_NONE;
1576 1.10 onoe return;
1577 1.10 onoe }
1578 1.37 onoe if (sc->sc_substate != AWI_ST_NONE)
1579 1.37 onoe (void)ieee80211_new_state(&sc->sc_ic.ic_if, sc->sc_nstate, -1);
1580 1.1 sommerfe }
1581 1.1 sommerfe
1582 1.10 onoe static int
1583 1.37 onoe awi_next_txd(struct awi_softc *sc, int len, u_int32_t *framep, u_int32_t *ntxdp)
1584 1.1 sommerfe {
1585 1.10 onoe u_int32_t txd, ntxd, frame;
1586 1.1 sommerfe
1587 1.10 onoe txd = sc->sc_txnext;
1588 1.10 onoe frame = txd + AWI_TXD_SIZE;
1589 1.10 onoe if (frame + len > sc->sc_txend)
1590 1.10 onoe frame = sc->sc_txbase;
1591 1.10 onoe ntxd = frame + len;
1592 1.10 onoe if (ntxd + AWI_TXD_SIZE > sc->sc_txend)
1593 1.10 onoe ntxd = sc->sc_txbase;
1594 1.10 onoe *framep = frame;
1595 1.10 onoe *ntxdp = ntxd;
1596 1.10 onoe /*
1597 1.10 onoe * Determine if there are any room in ring buffer.
1598 1.10 onoe * --- send wait, === new data, +++ conflict (ENOBUFS)
1599 1.10 onoe * base........................end
1600 1.10 onoe * done----txd=====ntxd OK
1601 1.10 onoe * --txd=====done++++ntxd-- full
1602 1.10 onoe * --txd=====ntxd done-- OK
1603 1.10 onoe * ==ntxd done----txd=== OK
1604 1.10 onoe * ==done++++ntxd----txd=== full
1605 1.10 onoe * ++ntxd txd=====done++ full
1606 1.10 onoe */
1607 1.10 onoe if (txd < ntxd) {
1608 1.10 onoe if (txd < sc->sc_txdone && ntxd + AWI_TXD_SIZE > sc->sc_txdone)
1609 1.10 onoe return ENOBUFS;
1610 1.10 onoe } else {
1611 1.10 onoe if (txd < sc->sc_txdone || ntxd + AWI_TXD_SIZE > sc->sc_txdone)
1612 1.10 onoe return ENOBUFS;
1613 1.1 sommerfe }
1614 1.10 onoe return 0;
1615 1.1 sommerfe }
1616 1.1 sommerfe
1617 1.10 onoe static int
1618 1.37 onoe awi_lock(struct awi_softc *sc)
1619 1.1 sommerfe {
1620 1.10 onoe int error = 0;
1621 1.1 sommerfe
1622 1.10 onoe if (curproc == NULL) {
1623 1.10 onoe /*
1624 1.10 onoe * XXX
1625 1.10 onoe * Though driver ioctl should be called with context,
1626 1.10 onoe * KAME ipv6 stack calls ioctl in interrupt for now.
1627 1.10 onoe * We simply abort the request if there are other
1628 1.10 onoe * ioctl requests in progress.
1629 1.10 onoe */
1630 1.20 onoe if (sc->sc_busy) {
1631 1.10 onoe return EWOULDBLOCK;
1632 1.20 onoe if (sc->sc_invalid)
1633 1.20 onoe return ENXIO;
1634 1.20 onoe }
1635 1.10 onoe sc->sc_busy = 1;
1636 1.10 onoe sc->sc_cansleep = 0;
1637 1.10 onoe return 0;
1638 1.1 sommerfe }
1639 1.10 onoe while (sc->sc_busy) {
1640 1.20 onoe if (sc->sc_invalid)
1641 1.20 onoe return ENXIO;
1642 1.10 onoe sc->sc_sleep_cnt++;
1643 1.10 onoe error = tsleep(sc, PWAIT | PCATCH, "awilck", 0);
1644 1.10 onoe sc->sc_sleep_cnt--;
1645 1.10 onoe if (error)
1646 1.10 onoe return error;
1647 1.6 sommerfe }
1648 1.10 onoe sc->sc_busy = 1;
1649 1.10 onoe sc->sc_cansleep = 1;
1650 1.10 onoe return 0;
1651 1.10 onoe }
1652 1.1 sommerfe
1653 1.10 onoe static void
1654 1.37 onoe awi_unlock(struct awi_softc *sc)
1655 1.10 onoe {
1656 1.10 onoe sc->sc_busy = 0;
1657 1.10 onoe sc->sc_cansleep = 0;
1658 1.10 onoe if (sc->sc_sleep_cnt)
1659 1.10 onoe wakeup(sc);
1660 1.1 sommerfe }
1661 1.1 sommerfe
1662 1.10 onoe static int
1663 1.37 onoe awi_intr_lock(struct awi_softc *sc)
1664 1.10 onoe {
1665 1.1 sommerfe u_int8_t status;
1666 1.10 onoe int i, retry;
1667 1.10 onoe
1668 1.10 onoe status = 1;
1669 1.10 onoe for (retry = 0; retry < 10; retry++) {
1670 1.10 onoe for (i = 0; i < AWI_LOCKOUT_TIMEOUT*1000/5; i++) {
1671 1.37 onoe if ((status = awi_read_1(sc, AWI_LOCKOUT_HOST)) == 0)
1672 1.10 onoe break;
1673 1.10 onoe DELAY(5);
1674 1.10 onoe }
1675 1.10 onoe if (status != 0)
1676 1.10 onoe break;
1677 1.10 onoe awi_write_1(sc, AWI_LOCKOUT_MAC, 1);
1678 1.37 onoe if ((status = awi_read_1(sc, AWI_LOCKOUT_HOST)) == 0)
1679 1.10 onoe break;
1680 1.10 onoe awi_write_1(sc, AWI_LOCKOUT_MAC, 0);
1681 1.1 sommerfe }
1682 1.10 onoe if (status != 0) {
1683 1.10 onoe printf("%s: failed to lock interrupt\n",
1684 1.6 sommerfe sc->sc_dev.dv_xname);
1685 1.10 onoe return ENXIO;
1686 1.6 sommerfe }
1687 1.10 onoe return 0;
1688 1.1 sommerfe }
1689 1.1 sommerfe
1690 1.10 onoe static void
1691 1.37 onoe awi_intr_unlock(struct awi_softc *sc)
1692 1.1 sommerfe {
1693 1.1 sommerfe
1694 1.10 onoe awi_write_1(sc, AWI_LOCKOUT_MAC, 0);
1695 1.1 sommerfe }
1696 1.1 sommerfe
1697 1.10 onoe static int
1698 1.37 onoe awi_newstate(void *arg, enum ieee80211_state nstate)
1699 1.1 sommerfe {
1700 1.37 onoe struct awi_softc *sc = arg;
1701 1.37 onoe struct ieee80211com *ic = &sc->sc_ic;
1702 1.47 onoe struct ieee80211_node *ni;
1703 1.37 onoe struct ifnet *ifp = &ic->ic_if;
1704 1.40 onoe int error;
1705 1.37 onoe u_int8_t newmode;
1706 1.37 onoe enum ieee80211_state ostate;
1707 1.37 onoe #ifdef AWI_DEBUG
1708 1.37 onoe static const char *stname[] =
1709 1.37 onoe { "INIT", "SCAN", "AUTH", "ASSOC", "RUN" };
1710 1.37 onoe static const char *substname[] =
1711 1.37 onoe { "NONE", "SCAN_INIT", "SCAN_SETMIB", "SCAN_SCCMD",
1712 1.37 onoe "SUB_INIT", "SUB_SETSS", "SUB_SYNC" };
1713 1.37 onoe #endif /* AWI_DEBUG */
1714 1.37 onoe
1715 1.37 onoe ostate = ic->ic_state;
1716 1.37 onoe DPRINTF(("awi_newstate: %s (%s/%s) -> %s\n", stname[ostate],
1717 1.37 onoe stname[sc->sc_nstate], substname[sc->sc_substate], stname[nstate]));
1718 1.37 onoe
1719 1.37 onoe /* set LED */
1720 1.37 onoe switch (nstate) {
1721 1.37 onoe case IEEE80211_S_INIT:
1722 1.37 onoe awi_drvstate(sc, AWI_DRV_RESET);
1723 1.37 onoe break;
1724 1.37 onoe case IEEE80211_S_SCAN:
1725 1.47 onoe if (ic->ic_opmode == IEEE80211_M_ADHOC)
1726 1.37 onoe awi_drvstate(sc, AWI_DRV_ADHSC);
1727 1.37 onoe else
1728 1.37 onoe awi_drvstate(sc, AWI_DRV_INFSY);
1729 1.37 onoe break;
1730 1.37 onoe case IEEE80211_S_AUTH:
1731 1.37 onoe awi_drvstate(sc, AWI_DRV_INFSY);
1732 1.37 onoe break;
1733 1.37 onoe case IEEE80211_S_ASSOC:
1734 1.37 onoe awi_drvstate(sc, AWI_DRV_INFAUTH);
1735 1.37 onoe break;
1736 1.37 onoe case IEEE80211_S_RUN:
1737 1.47 onoe if (ic->ic_opmode == IEEE80211_M_ADHOC)
1738 1.37 onoe awi_drvstate(sc, AWI_DRV_ADHSY);
1739 1.37 onoe else
1740 1.37 onoe awi_drvstate(sc, AWI_DRV_INFASSOC);
1741 1.37 onoe break;
1742 1.37 onoe }
1743 1.37 onoe
1744 1.37 onoe if (nstate == IEEE80211_S_INIT) {
1745 1.37 onoe sc->sc_substate = AWI_ST_NONE;
1746 1.37 onoe ic->ic_flags &= ~IEEE80211_F_SIBSS;
1747 1.37 onoe return 0;
1748 1.37 onoe }
1749 1.10 onoe
1750 1.37 onoe /* state transition */
1751 1.37 onoe if (nstate == IEEE80211_S_SCAN) {
1752 1.37 onoe /* SCAN substate */
1753 1.37 onoe if (sc->sc_substate == AWI_ST_NONE) {
1754 1.37 onoe sc->sc_nstate = nstate; /* next state in transition */
1755 1.37 onoe sc->sc_substate = AWI_ST_SCAN_INIT;
1756 1.37 onoe }
1757 1.37 onoe switch (sc->sc_substate) {
1758 1.37 onoe case AWI_ST_SCAN_INIT:
1759 1.37 onoe sc->sc_substate = AWI_ST_SCAN_SETMIB;
1760 1.37 onoe switch (ostate) {
1761 1.37 onoe case IEEE80211_S_RUN:
1762 1.37 onoe /* beacon miss */
1763 1.37 onoe if (ifp->if_flags & IFF_DEBUG)
1764 1.37 onoe printf("%s: no recent beacons from %s;"
1765 1.37 onoe " rescanning\n",
1766 1.37 onoe ifp->if_xname,
1767 1.47 onoe ether_sprintf(ic->ic_bss.ni_bssid));
1768 1.37 onoe /* FALLTHRU */
1769 1.37 onoe case IEEE80211_S_AUTH:
1770 1.37 onoe case IEEE80211_S_ASSOC:
1771 1.37 onoe /* timeout restart scan */
1772 1.48 onoe ieee80211_free_allnodes(ic);
1773 1.37 onoe /* FALLTHRU */
1774 1.37 onoe case IEEE80211_S_INIT:
1775 1.37 onoe ic->ic_flags |= IEEE80211_F_ASCAN;
1776 1.37 onoe ic->ic_scan_timer = 0;
1777 1.37 onoe /* FALLTHRU */
1778 1.37 onoe case IEEE80211_S_SCAN:
1779 1.37 onoe /* scan next */
1780 1.37 onoe break;
1781 1.37 onoe }
1782 1.37 onoe if (ic->ic_flags & IEEE80211_F_ASCAN)
1783 1.37 onoe newmode = AWI_SCAN_ACTIVE;
1784 1.37 onoe else
1785 1.37 onoe newmode = AWI_SCAN_PASSIVE;
1786 1.37 onoe if (sc->sc_mib_mgt.aScan_Mode != newmode) {
1787 1.37 onoe sc->sc_mib_mgt.aScan_Mode = newmode;
1788 1.37 onoe if ((error = awi_mib(sc, AWI_CMD_SET_MIB,
1789 1.37 onoe AWI_MIB_MGT, AWI_NOWAIT)) != 0)
1790 1.37 onoe break;
1791 1.37 onoe }
1792 1.37 onoe /* FALLTHRU */
1793 1.37 onoe case AWI_ST_SCAN_SETMIB:
1794 1.37 onoe sc->sc_substate = AWI_ST_SCAN_SCCMD;
1795 1.37 onoe if (sc->sc_cmd_inprog) {
1796 1.37 onoe if ((error = awi_cmd_wait(sc)) != 0)
1797 1.37 onoe break;
1798 1.37 onoe }
1799 1.37 onoe sc->sc_cmd_inprog = AWI_CMD_SCAN;
1800 1.47 onoe ni = &ic->ic_bss;
1801 1.37 onoe awi_write_2(sc, AWI_CA_SCAN_DURATION,
1802 1.37 onoe (ic->ic_flags & IEEE80211_F_ASCAN) ?
1803 1.37 onoe AWI_ASCAN_DURATION : AWI_PSCAN_DURATION);
1804 1.37 onoe if (sc->sc_mib_phy.IEEE_PHY_Type == AWI_PHY_TYPE_FH) {
1805 1.39 onoe awi_write_1(sc, AWI_CA_SCAN_SET,
1806 1.47 onoe IEEE80211_FH_CHANSET(ni->ni_chan));
1807 1.37 onoe awi_write_1(sc, AWI_CA_SCAN_PATTERN,
1808 1.47 onoe IEEE80211_FH_CHANPAT(ni->ni_chan));
1809 1.37 onoe awi_write_1(sc, AWI_CA_SCAN_IDX, 1);
1810 1.37 onoe } else {
1811 1.47 onoe awi_write_1(sc, AWI_CA_SCAN_SET, ni->ni_chan);
1812 1.37 onoe awi_write_1(sc, AWI_CA_SCAN_PATTERN, 0);
1813 1.37 onoe awi_write_1(sc, AWI_CA_SCAN_IDX, 0);
1814 1.37 onoe }
1815 1.37 onoe awi_write_1(sc, AWI_CA_SCAN_SUSP, 0);
1816 1.47 onoe sc->sc_cur_chan = ni->ni_chan;
1817 1.37 onoe if ((error = awi_cmd(sc, AWI_CMD_SCAN, AWI_NOWAIT))
1818 1.37 onoe != 0)
1819 1.37 onoe break;
1820 1.37 onoe /* FALLTHRU */
1821 1.37 onoe case AWI_ST_SCAN_SCCMD:
1822 1.37 onoe if (ic->ic_scan_timer == 0)
1823 1.37 onoe ic->ic_scan_timer =
1824 1.37 onoe (ic->ic_flags & IEEE80211_F_ASCAN) ?
1825 1.37 onoe IEEE80211_ASCAN_WAIT : IEEE80211_PSCAN_WAIT;
1826 1.37 onoe ifp->if_timer = 1;
1827 1.37 onoe ic->ic_state = nstate;
1828 1.37 onoe sc->sc_substate = AWI_ST_NONE;
1829 1.37 onoe error = EINPROGRESS;
1830 1.37 onoe break;
1831 1.37 onoe default:
1832 1.37 onoe DPRINTF(("awi_newstate: unexpected state %s/%s\n",
1833 1.37 onoe stname[nstate], substname[sc->sc_substate]));
1834 1.37 onoe sc->sc_substate = AWI_ST_NONE;
1835 1.37 onoe error = EIO;
1836 1.37 onoe break;
1837 1.20 onoe }
1838 1.37 onoe return error;
1839 1.37 onoe }
1840 1.37 onoe
1841 1.37 onoe if (ostate == IEEE80211_S_SCAN) {
1842 1.37 onoe /* set SSID and channel */
1843 1.37 onoe /* substate */
1844 1.37 onoe if (sc->sc_substate == AWI_ST_NONE) {
1845 1.37 onoe sc->sc_nstate = nstate; /* next state in transition */
1846 1.37 onoe sc->sc_substate = AWI_ST_SUB_INIT;
1847 1.37 onoe }
1848 1.47 onoe ni = &ic->ic_bss;
1849 1.37 onoe switch (sc->sc_substate) {
1850 1.37 onoe case AWI_ST_SUB_INIT:
1851 1.37 onoe sc->sc_substate = AWI_ST_SUB_SETSS;
1852 1.47 onoe IEEE80211_ADDR_COPY(&sc->sc_mib_mgt.aCurrent_BSS_ID,
1853 1.47 onoe ni->ni_bssid);
1854 1.37 onoe memset(&sc->sc_mib_mgt.aCurrent_ESS_ID, 0,
1855 1.37 onoe AWI_ESS_ID_SIZE);
1856 1.37 onoe sc->sc_mib_mgt.aCurrent_ESS_ID[0] =
1857 1.37 onoe IEEE80211_ELEMID_SSID;
1858 1.47 onoe sc->sc_mib_mgt.aCurrent_ESS_ID[1] = ni->ni_esslen;
1859 1.37 onoe memcpy(&sc->sc_mib_mgt.aCurrent_ESS_ID[2],
1860 1.47 onoe ni->ni_essid, ni->ni_esslen);
1861 1.37 onoe LE_WRITE_2(&sc->sc_mib_mgt.aBeacon_Period,
1862 1.47 onoe ni->ni_intval);
1863 1.37 onoe if ((error = awi_mib(sc, AWI_CMD_SET_MIB, AWI_MIB_MGT,
1864 1.37 onoe AWI_NOWAIT)) != 0)
1865 1.10 onoe break;
1866 1.37 onoe /* FALLTHRU */
1867 1.37 onoe case AWI_ST_SUB_SETSS:
1868 1.37 onoe sc->sc_substate = AWI_ST_SUB_SYNC;
1869 1.37 onoe if (sc->sc_cmd_inprog) {
1870 1.43 onoe if ((error = awi_cmd_wait(sc)) != 0)
1871 1.37 onoe break;
1872 1.10 onoe }
1873 1.37 onoe sc->sc_cmd_inprog = AWI_CMD_SYNC;
1874 1.37 onoe if (sc->sc_mib_phy.IEEE_PHY_Type == AWI_PHY_TYPE_FH) {
1875 1.39 onoe awi_write_1(sc, AWI_CA_SYNC_SET,
1876 1.47 onoe IEEE80211_FH_CHANSET(ni->ni_chan));
1877 1.39 onoe awi_write_1(sc, AWI_CA_SYNC_PATTERN,
1878 1.47 onoe IEEE80211_FH_CHANPAT(ni->ni_chan));
1879 1.40 onoe awi_write_1(sc, AWI_CA_SYNC_IDX,
1880 1.47 onoe ni->ni_fhindex);
1881 1.40 onoe awi_write_2(sc, AWI_CA_SYNC_DWELL,
1882 1.47 onoe ni->ni_fhdwell);
1883 1.37 onoe } else {
1884 1.47 onoe awi_write_1(sc, AWI_CA_SYNC_SET, ni->ni_chan);
1885 1.37 onoe awi_write_1(sc, AWI_CA_SYNC_PATTERN, 0);
1886 1.40 onoe awi_write_1(sc, AWI_CA_SYNC_IDX, 0);
1887 1.40 onoe awi_write_2(sc, AWI_CA_SYNC_DWELL, 0);
1888 1.37 onoe }
1889 1.37 onoe if ((ic->ic_flags & IEEE80211_F_SIBSS) &&
1890 1.37 onoe !sc->sc_no_bssid)
1891 1.37 onoe awi_write_1(sc, AWI_CA_SYNC_STARTBSS, 1);
1892 1.10 onoe else
1893 1.37 onoe awi_write_1(sc, AWI_CA_SYNC_STARTBSS, 0);
1894 1.37 onoe awi_write_2(sc, AWI_CA_SYNC_MBZ, 0);
1895 1.37 onoe awi_write_bytes(sc, AWI_CA_SYNC_TIMESTAMP,
1896 1.47 onoe ni->ni_tstamp, 8);
1897 1.47 onoe awi_write_4(sc, AWI_CA_SYNC_REFTIME, ni->ni_rstamp);
1898 1.47 onoe sc->sc_cur_chan = ni->ni_chan;
1899 1.37 onoe if ((error = awi_cmd(sc, AWI_CMD_SYNC, AWI_NOWAIT))
1900 1.37 onoe != 0)
1901 1.37 onoe break;
1902 1.37 onoe /* FALLTHRU */
1903 1.37 onoe case AWI_ST_SUB_SYNC:
1904 1.37 onoe sc->sc_substate = AWI_ST_NONE;
1905 1.37 onoe if (ic->ic_flags & IEEE80211_F_SIBSS) {
1906 1.37 onoe if ((error = awi_mib(sc, AWI_CMD_GET_MIB,
1907 1.37 onoe AWI_MIB_MGT, AWI_WAIT)) != 0)
1908 1.37 onoe break;
1909 1.47 onoe IEEE80211_ADDR_COPY(ni->ni_bssid,
1910 1.47 onoe &sc->sc_mib_mgt.aCurrent_BSS_ID);
1911 1.37 onoe } else {
1912 1.37 onoe if (nstate == IEEE80211_S_RUN) {
1913 1.37 onoe sc->sc_rx_timer = 10;
1914 1.37 onoe ifp->if_timer = 1;
1915 1.37 onoe }
1916 1.37 onoe }
1917 1.37 onoe error = 0;
1918 1.37 onoe break;
1919 1.37 onoe default:
1920 1.37 onoe DPRINTF(("awi_newstate: unexpected state %s/%s\n",
1921 1.37 onoe stname[nstate], substname[sc->sc_substate]));
1922 1.37 onoe sc->sc_substate = AWI_ST_NONE;
1923 1.37 onoe error = EIO;
1924 1.37 onoe break;
1925 1.10 onoe }
1926 1.37 onoe return error;
1927 1.1 sommerfe }
1928 1.37 onoe
1929 1.37 onoe sc->sc_substate = AWI_ST_NONE;
1930 1.37 onoe
1931 1.37 onoe return 0;
1932 1.1 sommerfe }
1933 1.1 sommerfe
1934 1.37 onoe static struct mbuf *
1935 1.37 onoe awi_ether_encap(struct awi_softc *sc, struct mbuf *m)
1936 1.20 onoe {
1937 1.37 onoe struct ieee80211com *ic = &sc->sc_ic;
1938 1.47 onoe struct ieee80211_node *ni = &ic->ic_bss;
1939 1.37 onoe struct ether_header *eh;
1940 1.37 onoe struct ieee80211_frame *wh;
1941 1.20 onoe
1942 1.37 onoe if (m->m_len < sizeof(struct ether_header)) {
1943 1.37 onoe m = m_pullup(m, sizeof(struct ether_header));
1944 1.37 onoe if (m == NULL)
1945 1.37 onoe return NULL;
1946 1.20 onoe }
1947 1.37 onoe eh = mtod(m, struct ether_header *);
1948 1.37 onoe M_PREPEND(m, sizeof(struct ieee80211_frame), M_DONTWAIT);
1949 1.37 onoe if (m == NULL)
1950 1.37 onoe return NULL;
1951 1.37 onoe wh = mtod(m, struct ieee80211_frame *);
1952 1.37 onoe wh->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_DATA;
1953 1.37 onoe *(u_int16_t *)wh->i_dur = 0;
1954 1.37 onoe *(u_int16_t *)wh->i_seq =
1955 1.47 onoe htole16(ni->ni_txseq << IEEE80211_SEQ_SEQ_SHIFT);
1956 1.47 onoe ni->ni_txseq++;
1957 1.47 onoe if (ic->ic_opmode == IEEE80211_M_ADHOC) {
1958 1.37 onoe wh->i_fc[1] = IEEE80211_FC1_DIR_NODS;
1959 1.37 onoe if (sc->sc_adhoc_ap)
1960 1.47 onoe IEEE80211_ADDR_COPY(wh->i_addr1, ni->ni_macaddr);
1961 1.37 onoe else
1962 1.47 onoe IEEE80211_ADDR_COPY(wh->i_addr1, eh->ether_dhost);
1963 1.47 onoe IEEE80211_ADDR_COPY(wh->i_addr2, eh->ether_shost);
1964 1.47 onoe IEEE80211_ADDR_COPY(wh->i_addr3, ni->ni_bssid);
1965 1.20 onoe } else {
1966 1.37 onoe wh->i_fc[1] = IEEE80211_FC1_DIR_TODS;
1967 1.47 onoe IEEE80211_ADDR_COPY(wh->i_addr1, ni->ni_bssid);
1968 1.47 onoe IEEE80211_ADDR_COPY(wh->i_addr2, eh->ether_shost);
1969 1.47 onoe IEEE80211_ADDR_COPY(wh->i_addr3, eh->ether_dhost);
1970 1.20 onoe }
1971 1.37 onoe return m;
1972 1.20 onoe }
1973 1.20 onoe
1974 1.37 onoe static struct mbuf *
1975 1.37 onoe awi_ether_modcap(struct awi_softc *sc, struct mbuf *m)
1976 1.1 sommerfe {
1977 1.37 onoe struct ieee80211com *ic = &sc->sc_ic;
1978 1.37 onoe struct ether_header eh;
1979 1.37 onoe struct ieee80211_frame wh;
1980 1.37 onoe struct llc *llc;
1981 1.1 sommerfe
1982 1.37 onoe if (m->m_len < sizeof(wh) + sizeof(eh)) {
1983 1.37 onoe m = m_pullup(m, sizeof(wh) + sizeof(eh));
1984 1.37 onoe if (m == NULL)
1985 1.37 onoe return NULL;
1986 1.10 onoe }
1987 1.37 onoe memcpy(&wh, mtod(m, caddr_t), sizeof(wh));
1988 1.37 onoe if (wh.i_fc[0] != (IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_DATA))
1989 1.37 onoe return m;
1990 1.37 onoe memcpy(&eh, mtod(m, caddr_t) + sizeof(wh), sizeof(eh));
1991 1.37 onoe m_adj(m, sizeof(eh) - sizeof(*llc));
1992 1.47 onoe if (ic->ic_opmode == IEEE80211_M_ADHOC)
1993 1.47 onoe IEEE80211_ADDR_COPY(wh.i_addr2, eh.ether_shost);
1994 1.37 onoe memcpy(mtod(m, caddr_t), &wh, sizeof(wh));
1995 1.37 onoe llc = (struct llc *)(mtod(m, caddr_t) + sizeof(wh));
1996 1.37 onoe llc->llc_dsap = llc->llc_ssap = LLC_SNAP_LSAP;
1997 1.37 onoe llc->llc_control = LLC_UI;
1998 1.37 onoe llc->llc_snap.org_code[0] = 0;
1999 1.37 onoe llc->llc_snap.org_code[1] = 0;
2000 1.37 onoe llc->llc_snap.org_code[2] = 0;
2001 1.37 onoe llc->llc_snap.ether_type = eh.ether_type;
2002 1.37 onoe return m;
2003 1.1 sommerfe }
2004