xref: /freebsd/sys/dev/iwm/if_iwm_mac_ctxt.c (revision 685dc743dc3b5645e34836464128e1c0558b404b)
1 /*	$OpenBSD: if_iwm.c,v 1.39 2015/03/23 00:35:19 jsg Exp $	*/
2 
3 /*
4  * Copyright (c) 2014 genua mbh <info@genua.de>
5  * Copyright (c) 2014 Fixup Software Ltd.
6  *
7  * Permission to use, copy, modify, and distribute this software for any
8  * purpose with or without fee is hereby granted, provided that the above
9  * copyright notice and this permission notice appear in all copies.
10  *
11  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
12  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
13  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
14  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
15  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
16  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
17  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18  */
19 
20 /*-
21  * Based on BSD-licensed source modules in the Linux iwlwifi driver,
22  * which were used as the reference documentation for this implementation.
23  *
24  * Driver version we are currently based off of is
25  * Linux 3.14.3 (tag id a2df521e42b1d9a23f620ac79dbfe8655a8391dd)
26  *
27  ***********************************************************************
28  *
29  * This file is provided under a dual BSD/GPLv2 license.  When using or
30  * redistributing this file, you may do so under either license.
31  *
32  * GPL LICENSE SUMMARY
33  *
34  * Copyright(c) 2007 - 2013 Intel Corporation. All rights reserved.
35  *
36  * This program is free software; you can redistribute it and/or modify
37  * it under the terms of version 2 of the GNU General Public License as
38  * published by the Free Software Foundation.
39  *
40  * This program is distributed in the hope that it will be useful, but
41  * WITHOUT ANY WARRANTY; without even the implied warranty of
42  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
43  * General Public License for more details.
44  *
45  * You should have received a copy of the GNU General Public License
46  * along with this program; if not, write to the Free Software
47  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
48  * USA
49  *
50  * The full GNU General Public License is included in this distribution
51  * in the file called COPYING.
52  *
53  * Contact Information:
54  *  Intel Linux Wireless <ilw@linux.intel.com>
55  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
56  *
57  *
58  * BSD LICENSE
59  *
60  * Copyright(c) 2005 - 2013 Intel Corporation. All rights reserved.
61  * All rights reserved.
62  *
63  * Redistribution and use in source and binary forms, with or without
64  * modification, are permitted provided that the following conditions
65  * are met:
66  *
67  *  * Redistributions of source code must retain the above copyright
68  *    notice, this list of conditions and the following disclaimer.
69  *  * Redistributions in binary form must reproduce the above copyright
70  *    notice, this list of conditions and the following disclaimer in
71  *    the documentation and/or other materials provided with the
72  *    distribution.
73  *  * Neither the name Intel Corporation nor the names of its
74  *    contributors may be used to endorse or promote products derived
75  *    from this software without specific prior written permission.
76  *
77  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
78  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
79  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
80  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
81  * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
82  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
83  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
84  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
85  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
86  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
87  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
88  */
89 
90 /*-
91  * Copyright (c) 2007-2010 Damien Bergamini <damien.bergamini@free.fr>
92  *
93  * Permission to use, copy, modify, and distribute this software for any
94  * purpose with or without fee is hereby granted, provided that the above
95  * copyright notice and this permission notice appear in all copies.
96  *
97  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
98  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
99  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
100  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
101  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
102  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
103  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
104  */
105 #include <sys/cdefs.h>
106 #include "opt_wlan.h"
107 #include "opt_iwm.h"
108 
109 #include <sys/param.h>
110 #include <sys/bus.h>
111 #include <sys/conf.h>
112 #include <sys/endian.h>
113 #include <sys/firmware.h>
114 #include <sys/kernel.h>
115 #include <sys/malloc.h>
116 #include <sys/mbuf.h>
117 #include <sys/mutex.h>
118 #include <sys/module.h>
119 #include <sys/proc.h>
120 #include <sys/rman.h>
121 #include <sys/socket.h>
122 #include <sys/sockio.h>
123 #include <sys/sysctl.h>
124 #include <sys/linker.h>
125 
126 #include <machine/bus.h>
127 #include <machine/endian.h>
128 #include <machine/resource.h>
129 
130 #include <dev/pci/pcivar.h>
131 #include <dev/pci/pcireg.h>
132 
133 #include <net/bpf.h>
134 
135 #include <net/if.h>
136 #include <net/if_var.h>
137 #include <net/if_arp.h>
138 #include <net/if_dl.h>
139 #include <net/if_media.h>
140 #include <net/if_types.h>
141 
142 #include <netinet/in.h>
143 #include <netinet/in_systm.h>
144 #include <netinet/if_ether.h>
145 #include <netinet/ip.h>
146 
147 #include <net80211/ieee80211_var.h>
148 #include <net80211/ieee80211_regdomain.h>
149 #include <net80211/ieee80211_ratectl.h>
150 #include <net80211/ieee80211_radiotap.h>
151 
152 #include <dev/iwm/if_iwmreg.h>
153 #include <dev/iwm/if_iwmvar.h>
154 #include <dev/iwm/if_iwm_debug.h>
155 #include <dev/iwm/if_iwm_util.h>
156 #include <dev/iwm/if_iwm_mac_ctxt.h>
157 
158 /*
159  * BEGIN mvm/mac-ctxt.c
160  */
161 
162 const uint8_t iwm_ac_to_tx_fifo[] = {
163 	IWM_TX_FIFO_BE,
164 	IWM_TX_FIFO_BK,
165 	IWM_TX_FIFO_VI,
166 	IWM_TX_FIFO_VO,
167 };
168 
169 static void
iwm_ack_rates(struct iwm_softc * sc,int is2ghz,int * cck_rates,int * ofdm_rates,struct iwm_node * in)170 iwm_ack_rates(struct iwm_softc *sc, int is2ghz,
171 	int *cck_rates, int *ofdm_rates, struct iwm_node *in)
172 {
173 	int lowest_present_ofdm = 100;
174 	int lowest_present_cck = 100;
175 	uint8_t cck = 0;
176 	uint8_t ofdm = 0;
177 	int i;
178 	struct ieee80211_rateset *rs = &in->in_ni.ni_rates;
179 
180 	if (is2ghz) {
181 		for (i = IWM_FIRST_CCK_RATE; i <= IWM_LAST_CCK_RATE; i++) {
182 			if ((iwm_ridx2rate(rs, i) & IEEE80211_RATE_BASIC) == 0)
183 				continue;
184 			cck |= (1 << i);
185 			if (lowest_present_cck > i)
186 				lowest_present_cck = i;
187 		}
188 	}
189 	for (i = IWM_FIRST_OFDM_RATE; i <= IWM_LAST_NON_HT_RATE; i++) {
190 		if ((iwm_ridx2rate(rs, i) & IEEE80211_RATE_BASIC) == 0)
191 			continue;
192 		ofdm |= (1 << (i - IWM_FIRST_OFDM_RATE));
193 		if (lowest_present_ofdm > i)
194 			lowest_present_ofdm = i;
195 	}
196 
197 	/*
198 	 * Now we've got the basic rates as bitmaps in the ofdm and cck
199 	 * variables. This isn't sufficient though, as there might not
200 	 * be all the right rates in the bitmap. E.g. if the only basic
201 	 * rates are 5.5 Mbps and 11 Mbps, we still need to add 1 Mbps
202 	 * and 6 Mbps because the 802.11-2007 standard says in 9.6:
203 	 *
204 	 *    [...] a STA responding to a received frame shall transmit
205 	 *    its Control Response frame [...] at the highest rate in the
206 	 *    BSSBasicRateSet parameter that is less than or equal to the
207 	 *    rate of the immediately previous frame in the frame exchange
208 	 *    sequence ([...]) and that is of the same modulation class
209 	 *    ([...]) as the received frame. If no rate contained in the
210 	 *    BSSBasicRateSet parameter meets these conditions, then the
211 	 *    control frame sent in response to a received frame shall be
212 	 *    transmitted at the highest mandatory rate of the PHY that is
213 	 *    less than or equal to the rate of the received frame, and
214 	 *    that is of the same modulation class as the received frame.
215 	 *
216 	 * As a consequence, we need to add all mandatory rates that are
217 	 * lower than all of the basic rates to these bitmaps.
218 	 */
219 
220 	if (IWM_RATE_24M_INDEX < lowest_present_ofdm)
221 		ofdm |= IWM_RATE_BIT_MSK(24) >> IWM_FIRST_OFDM_RATE;
222 	if (IWM_RATE_12M_INDEX < lowest_present_ofdm)
223 		ofdm |= IWM_RATE_BIT_MSK(12) >> IWM_FIRST_OFDM_RATE;
224 	/* 6M already there or needed so always add */
225 	ofdm |= IWM_RATE_BIT_MSK(6) >> IWM_FIRST_OFDM_RATE;
226 
227 	/*
228 	 * CCK is a bit more complex with DSSS vs. HR/DSSS vs. ERP.
229 	 * Note, however:
230 	 *  - if no CCK rates are basic, it must be ERP since there must
231 	 *    be some basic rates at all, so they're OFDM => ERP PHY
232 	 *    (or we're in 5 GHz, and the cck bitmap will never be used)
233 	 *  - if 11M is a basic rate, it must be ERP as well, so add 5.5M
234 	 *  - if 5.5M is basic, 1M and 2M are mandatory
235 	 *  - if 2M is basic, 1M is mandatory
236 	 *  - if 1M is basic, that's the only valid ACK rate.
237 	 * As a consequence, it's not as complicated as it sounds, just add
238 	 * any lower rates to the ACK rate bitmap.
239 	 */
240 	if (IWM_RATE_11M_INDEX < lowest_present_cck)
241 		cck |= IWM_RATE_BIT_MSK(11) >> IWM_FIRST_CCK_RATE;
242 	if (IWM_RATE_5M_INDEX < lowest_present_cck)
243 		cck |= IWM_RATE_BIT_MSK(5) >> IWM_FIRST_CCK_RATE;
244 	if (IWM_RATE_2M_INDEX < lowest_present_cck)
245 		cck |= IWM_RATE_BIT_MSK(2) >> IWM_FIRST_CCK_RATE;
246 	/* 1M already there or needed so always add */
247 	cck |= IWM_RATE_BIT_MSK(1) >> IWM_FIRST_CCK_RATE;
248 
249 	*cck_rates = cck;
250 	*ofdm_rates = ofdm;
251 }
252 
253 static void
iwm_mac_ctxt_cmd_common(struct iwm_softc * sc,struct iwm_node * in,struct iwm_mac_ctx_cmd * cmd,uint32_t action)254 iwm_mac_ctxt_cmd_common(struct iwm_softc *sc, struct iwm_node *in,
255 	struct iwm_mac_ctx_cmd *cmd, uint32_t action)
256 {
257 	struct ieee80211com *ic = &sc->sc_ic;
258 	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
259 	struct ieee80211_node *ni = vap->iv_bss;
260 	struct iwm_vap *ivp = IWM_VAP(vap);
261 	int cck_ack_rates, ofdm_ack_rates;
262 	int i;
263 	int is2ghz;
264 
265 	/*
266 	 * id is the MAC address ID - something to do with MAC filtering.
267 	 * color - not sure.
268 	 *
269 	 * These are both functions of the vap, not of the node.
270 	 * So, for now, hard-code both to 0 (default).
271 	 */
272 	cmd->id_and_color = htole32(IWM_FW_CMD_ID_AND_COLOR(ivp->id,
273 	    ivp->color));
274 	cmd->action = htole32(action);
275 
276 	cmd->mac_type = htole32(IWM_FW_MAC_TYPE_BSS_STA);
277 
278 	/*
279 	 * The TSF ID is one of four TSF tracking resources in the firmware.
280 	 * Read the iwlwifi/mvm code for more details.
281 	 *
282 	 * For now, just hard-code it to TSF tracking ID 0; we only support
283 	 * a single STA mode VAP.
284 	 *
285 	 * It's per-vap, not per-node.
286 	 */
287 	cmd->tsf_id = htole32(IWM_DEFAULT_TSFID);
288 
289 	IEEE80211_ADDR_COPY(cmd->node_addr, vap->iv_myaddr);
290 
291 	/*
292 	 * XXX should we error out if in_assoc is 1 and ni == NULL?
293 	 */
294 #if 0
295 	if (in->in_assoc) {
296 		IEEE80211_ADDR_COPY(cmd->bssid_addr, ni->ni_bssid);
297 	} else {
298 		/* eth broadcast address */
299 		IEEE80211_ADDR_COPY(cmd->bssid_addr, ieee80211broadcastaddr);
300 	}
301 #else
302 	/*
303 	 * XXX This workaround makes the firmware behave more correctly once
304 	 *     we are associated, regularly giving us statistics notifications,
305 	 *     as well as signaling missed beacons to us.
306 	 *     Since we only call iwm_mac_ctxt_add() and
307 	 *     iwm_mac_ctxt_changed() when already authenticating or
308 	 *     associating, ni->ni_bssid should always make sense here.
309 	 */
310 	if (ivp->iv_auth) {
311 		IEEE80211_ADDR_COPY(cmd->bssid_addr, ni->ni_bssid);
312 	} else {
313 		/* XXX Or maybe all zeroes address? */
314 		IEEE80211_ADDR_COPY(cmd->bssid_addr, ieee80211broadcastaddr);
315 	}
316 #endif
317 
318 	/*
319 	 * Default to 2ghz if no node information is given.
320 	 */
321 	if (in && in->in_ni.ni_chan != IEEE80211_CHAN_ANYC) {
322 		is2ghz = !! IEEE80211_IS_CHAN_2GHZ(in->in_ni.ni_chan);
323 	} else {
324 		is2ghz = 1;
325 	}
326 	iwm_ack_rates(sc, is2ghz, &cck_ack_rates, &ofdm_ack_rates, in);
327 	cmd->cck_rates = htole32(cck_ack_rates);
328 	cmd->ofdm_rates = htole32(ofdm_ack_rates);
329 
330 	cmd->cck_short_preamble
331 	    = htole32((ic->ic_flags & IEEE80211_F_SHPREAMBLE)
332 	      ? IWM_MAC_FLG_SHORT_PREAMBLE : 0);
333 	cmd->short_slot
334 	    = htole32((ic->ic_flags & IEEE80211_F_SHSLOT)
335 	      ? IWM_MAC_FLG_SHORT_SLOT : 0);
336 
337 	/*
338 	 * XXX TODO: if we're doing QOS..
339 	 * cmd->qos_flags |= cpu_to_le32(MAC_QOS_FLG_UPDATE_EDCA)
340 	 */
341 
342 	for (i = 0; i < WME_NUM_AC; i++) {
343 		uint8_t txf = iwm_ac_to_tx_fifo[i];
344 
345 		cmd->ac[txf].cw_min = htole16(ivp->queue_params[i].cw_min);
346 		cmd->ac[txf].cw_max = htole16(ivp->queue_params[i].cw_max);
347 		cmd->ac[txf].edca_txop =
348 		    htole16(ivp->queue_params[i].edca_txop);
349 		cmd->ac[txf].aifsn = ivp->queue_params[i].aifsn;
350 		cmd->ac[txf].fifos_mask = (1 << txf);
351 	}
352 
353 	if (ivp->have_wme)
354 		cmd->qos_flags |= htole32(IWM_MAC_QOS_FLG_UPDATE_EDCA);
355 
356 	if (ic->ic_flags & IEEE80211_F_USEPROT)
357 		cmd->protection_flags |= htole32(IWM_MAC_PROT_FLG_TGG_PROTECT);
358 
359 	cmd->filter_flags = htole32(IWM_MAC_FILTER_ACCEPT_GRP);
360 }
361 
362 static int
iwm_mac_ctxt_send_cmd(struct iwm_softc * sc,struct iwm_mac_ctx_cmd * cmd)363 iwm_mac_ctxt_send_cmd(struct iwm_softc *sc, struct iwm_mac_ctx_cmd *cmd)
364 {
365 	int ret = iwm_send_cmd_pdu(sc, IWM_MAC_CONTEXT_CMD, IWM_CMD_SYNC,
366 				       sizeof(*cmd), cmd);
367 	if (ret)
368 		device_printf(sc->sc_dev,
369 		    "%s: Failed to send MAC context (action:%d): %d\n",
370 		    __func__, le32toh(cmd->action), ret);
371 	return ret;
372 }
373 
374 /*
375  * Fill the specific data for mac context of type station or p2p client
376  */
377 static void
iwm_mac_ctxt_cmd_fill_sta(struct iwm_softc * sc,struct iwm_node * in,struct iwm_mac_data_sta * ctxt_sta,int force_assoc_off)378 iwm_mac_ctxt_cmd_fill_sta(struct iwm_softc *sc, struct iwm_node *in,
379 	struct iwm_mac_data_sta *ctxt_sta, int force_assoc_off)
380 {
381 	struct ieee80211_node *ni = &in->in_ni;
382 	unsigned dtim_period, dtim_count;
383 	struct ieee80211com *ic = &sc->sc_ic;
384 	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
385 
386 	/* will this work? */
387 	dtim_period = vap->iv_dtim_period;
388 	dtim_count = vap->iv_dtim_count;
389 	IWM_DPRINTF(sc, IWM_DEBUG_RESET | IWM_DEBUG_BEACON | IWM_DEBUG_CMD,
390 	    "%s: force_assoc_off=%d\n", __func__, force_assoc_off);
391 	IWM_DPRINTF(sc, IWM_DEBUG_RESET | IWM_DEBUG_BEACON | IWM_DEBUG_CMD,
392 	    "DTIM: period=%d count=%d\n", dtim_period, dtim_count);
393 	IWM_DPRINTF(sc, IWM_DEBUG_RESET | IWM_DEBUG_BEACON | IWM_DEBUG_CMD,
394 	    "BEACON: tsf: %llu, ni_intval=%d\n",
395 	    (unsigned long long) le64toh(ni->ni_tstamp.tsf),
396 	    ni->ni_intval);
397 
398 	/* We need the dtim_period to set the MAC as associated */
399 	if (in->in_assoc && dtim_period && !force_assoc_off) {
400 		uint64_t tsf;
401 		uint32_t dtim_offs;
402 
403 		/*
404 		 * The DTIM count counts down, so when it is N that means N
405 		 * more beacon intervals happen until the DTIM TBTT. Therefore
406 		 * add this to the current time. If that ends up being in the
407 		 * future, the firmware will handle it.
408 		 *
409 		 * Also note that the system_timestamp (which we get here as
410 		 * "sync_device_ts") and TSF timestamp aren't at exactly the
411 		 * same offset in the frame -- the TSF is at the first symbol
412 		 * of the TSF, the system timestamp is at signal acquisition
413 		 * time. This means there's an offset between them of at most
414 		 * a few hundred microseconds (24 * 8 bits + PLCP time gives
415 		 * 384us in the longest case), this is currently not relevant
416 		 * as the firmware wakes up around 2ms before the TBTT.
417 		 */
418 		dtim_offs = dtim_count * ni->ni_intval;
419 		/* convert TU to usecs */
420 		dtim_offs *= 1024;
421 
422 		/*
423 		 * net80211: TSF is in 802.11 order, so convert up to local
424 		 * ordering before we manipulate things.
425 		 */
426 		tsf = le64toh(ni->ni_tstamp.tsf);
427 
428 		ctxt_sta->dtim_tsf = htole64(tsf + dtim_offs);
429 		ctxt_sta->dtim_time = htole32(tsf + dtim_offs);
430 
431 		IWM_DPRINTF(sc, IWM_DEBUG_RESET | IWM_DEBUG_BEACON | IWM_DEBUG_CMD,
432 		    "DTIM TBTT is 0x%llx/0x%x, offset %d\n",
433 		    (long long)le64toh(ctxt_sta->dtim_tsf),
434 		    le32toh(ctxt_sta->dtim_time), dtim_offs);
435 
436 		ctxt_sta->is_assoc = htole32(1);
437 	} else {
438 		ctxt_sta->is_assoc = htole32(0);
439 	}
440 
441 	IWM_DPRINTF(sc, IWM_DEBUG_RESET | IWM_DEBUG_CMD | IWM_DEBUG_BEACON,
442 	    "%s: ni_intval: %d, bi_reciprocal: %d, dtim_interval: %d, dtim_reciprocal: %d\n",
443 	    __func__,
444 	    ni->ni_intval,
445 	    iwm_reciprocal(ni->ni_intval),
446 	    ni->ni_intval * dtim_period,
447 	    iwm_reciprocal(ni->ni_intval * dtim_period));
448 
449 	ctxt_sta->bi = htole32(ni->ni_intval);
450 	ctxt_sta->bi_reciprocal = htole32(iwm_reciprocal(ni->ni_intval));
451 	ctxt_sta->dtim_interval = htole32(ni->ni_intval * dtim_period);
452 	ctxt_sta->dtim_reciprocal =
453 	    htole32(iwm_reciprocal(ni->ni_intval * dtim_period));
454 
455 	/* 10 = CONN_MAX_LISTEN_INTERVAL */
456 	ctxt_sta->listen_interval = htole32(10);
457 	IWM_DPRINTF(sc, IWM_DEBUG_RESET | IWM_DEBUG_CMD | IWM_DEBUG_BEACON,
458 	    "%s: associd=%d\n", __func__, IEEE80211_AID(ni->ni_associd));
459 	ctxt_sta->assoc_id = htole32(IEEE80211_AID(ni->ni_associd));
460 }
461 
462 static int
iwm_mac_ctxt_cmd_station(struct iwm_softc * sc,struct ieee80211vap * vap,uint32_t action)463 iwm_mac_ctxt_cmd_station(struct iwm_softc *sc, struct ieee80211vap *vap,
464 	uint32_t action)
465 {
466 	struct ieee80211_node *ni = vap->iv_bss;
467 	struct iwm_node *in = IWM_NODE(ni);
468 	struct iwm_mac_ctx_cmd cmd = {};
469 
470 	IWM_DPRINTF(sc, IWM_DEBUG_RESET,
471 	    "%s: called; action=%d\n", __func__, action);
472 
473 	/* Fill the common data for all mac context types */
474 	iwm_mac_ctxt_cmd_common(sc, in, &cmd, action);
475 
476 	/* Allow beacons to pass through as long as we are not associated,or we
477 	 * do not have dtim period information */
478 	if (!in->in_assoc || !vap->iv_dtim_period)
479 		cmd.filter_flags |= htole32(IWM_MAC_FILTER_IN_BEACON);
480 	else
481 		cmd.filter_flags &= ~htole32(IWM_MAC_FILTER_IN_BEACON);
482 
483 	/* Fill the data specific for station mode */
484 	iwm_mac_ctxt_cmd_fill_sta(sc, in,
485 	    &cmd.sta, action == IWM_FW_CTXT_ACTION_ADD);
486 
487 	return iwm_mac_ctxt_send_cmd(sc, &cmd);
488 }
489 
490 static int
iwm_mac_ctx_send(struct iwm_softc * sc,struct ieee80211vap * vap,uint32_t action)491 iwm_mac_ctx_send(struct iwm_softc *sc, struct ieee80211vap *vap,
492     uint32_t action)
493 {
494 	return iwm_mac_ctxt_cmd_station(sc, vap, action);
495 }
496 
497 int
iwm_mac_ctxt_add(struct iwm_softc * sc,struct ieee80211vap * vap)498 iwm_mac_ctxt_add(struct iwm_softc *sc, struct ieee80211vap *vap)
499 {
500 	struct iwm_vap *iv = IWM_VAP(vap);
501 	int ret;
502 
503 	if (iv->is_uploaded != 0) {
504 		device_printf(sc->sc_dev, "%s: called; uploaded != 0\n",
505 		    __func__);
506 		return (EIO);
507 	}
508 
509 	ret = iwm_mac_ctx_send(sc, vap, IWM_FW_CTXT_ACTION_ADD);
510 	if (ret)
511 		return (ret);
512 	iv->is_uploaded = 1;
513 	return (0);
514 }
515 
516 int
iwm_mac_ctxt_changed(struct iwm_softc * sc,struct ieee80211vap * vap)517 iwm_mac_ctxt_changed(struct iwm_softc *sc, struct ieee80211vap *vap)
518 {
519 	struct iwm_vap *iv = IWM_VAP(vap);
520 
521 	if (iv->is_uploaded == 0) {
522 		device_printf(sc->sc_dev, "%s: called; uploaded = 0\n",
523 		    __func__);
524 		return (EIO);
525 	}
526 	return iwm_mac_ctx_send(sc, vap, IWM_FW_CTXT_ACTION_MODIFY);
527 }
528 
529 #if 0
530 static int
531 iwm_mac_ctxt_remove(struct iwm_softc *sc, struct iwm_node *in)
532 {
533 	struct iwm_mac_ctx_cmd cmd;
534 	int ret;
535 
536 	if (!in->in_uploaded) {
537 		device_printf(sc->sc_dev,
538 		    "attempt to remove !uploaded node %p", in);
539 		return EIO;
540 	}
541 
542 	memset(&cmd, 0, sizeof(cmd));
543 
544 	cmd.id_and_color = htole32(IWM_FW_CMD_ID_AND_COLOR(IWM_DEFAULT_MACID,
545 	    IWM_DEFAULT_COLOR));
546 	cmd.action = htole32(IWM_FW_CTXT_ACTION_REMOVE);
547 
548 	ret = iwm_send_cmd_pdu(sc,
549 	    IWM_MAC_CONTEXT_CMD, IWM_CMD_SYNC, sizeof(cmd), &cmd);
550 	if (ret) {
551 		device_printf(sc->sc_dev,
552 		    "Failed to remove MAC context: %d\n", ret);
553 		return ret;
554 	}
555 	in->in_uploaded = 0;
556 
557 	return 0;
558 }
559 #endif
560