/usr/src/sys/dev/pci/if

Bug Summary

File:	dev/pci/if_iwx.c
Warning:	line 733, column 6 Branch condition evaluates to a garbage value
Annotated Source Code

Press '?' to see keyboard shortcuts
Show analyzer invocation
clang -cc1 -cc1 -triple amd64-unknown-openbsd7.0 -analyze -disable-free -disable-llvm-verifier -discard-value-names -main-file-name if_iwx.c -analyzer-store=region -analyzer-opt-analyze-nested-blocks -analyzer-checker=core -analyzer-checker=apiModeling -analyzer-checker=unix -analyzer-checker=deadcode -analyzer-checker=security.insecureAPI.UncheckedReturn -analyzer-checker=security.insecureAPI.getpw -analyzer-checker=security.insecureAPI.gets -analyzer-checker=security.insecureAPI.mktemp -analyzer-checker=security.insecureAPI.mkstemp -analyzer-checker=security.insecureAPI.vfork -analyzer-checker=nullability.NullPassedToNonnull -analyzer-checker=nullability.NullReturnedFromNonnull -analyzer-output plist -w -setup-static-analyzer -mrelocation-model static -mframe-pointer=all -relaxed-aliasing -fno-rounding-math -mconstructor-aliases -ffreestanding -mcmodel=kernel -target-cpu x86-64 -target-feature +retpoline-indirect-calls -target-feature +retpoline-indirect-branches -target-feature -sse2 -target-feature -sse -target-feature -3dnow -target-feature -mmx -target-feature +save-args -disable-red-zone -no-implicit-float -tune-cpu generic -debugger-tuning=gdb -fcoverage-compilation-dir=/usr/src/sys/arch/amd64/compile/GENERIC.MP/obj -nostdsysteminc -nobuiltininc -resource-dir /usr/local/lib/clang/13.0.0 -I /usr/src/sys -I /usr/src/sys/arch/amd64/compile/GENERIC.MP/obj -I /usr/src/sys/arch -I /usr/src/sys/dev/pci/drm/include -I /usr/src/sys/dev/pci/drm/include/uapi -I /usr/src/sys/dev/pci/drm/amd/include/asic_reg -I /usr/src/sys/dev/pci/drm/amd/include -I /usr/src/sys/dev/pci/drm/amd/amdgpu -I /usr/src/sys/dev/pci/drm/amd/display -I /usr/src/sys/dev/pci/drm/amd/display/include -I /usr/src/sys/dev/pci/drm/amd/display/dc -I /usr/src/sys/dev/pci/drm/amd/display/amdgpu_dm -I /usr/src/sys/dev/pci/drm/amd/pm/inc -I /usr/src/sys/dev/pci/drm/amd/pm/swsmu -I /usr/src/sys/dev/pci/drm/amd/pm/swsmu/smu11 -I /usr/src/sys/dev/pci/drm/amd/pm/swsmu/smu12 -I /usr/src/sys/dev/pci/drm/amd/pm/powerplay -I /usr/src/sys/dev/pci/drm/amd/pm/powerplay/hwmgr -I /usr/src/sys/dev/pci/drm/amd/pm/powerplay/smumgr -I /usr/src/sys/dev/pci/drm/amd/display/dc/inc -I /usr/src/sys/dev/pci/drm/amd/display/dc/inc/hw -I /usr/src/sys/dev/pci/drm/amd/display/dc/clk_mgr -I /usr/src/sys/dev/pci/drm/amd/display/modules/inc -I /usr/src/sys/dev/pci/drm/amd/display/modules/hdcp -I /usr/src/sys/dev/pci/drm/amd/display/dmub/inc -I /usr/src/sys/dev/pci/drm/i915 -D DDB -D DIAGNOSTIC -D KTRACE -D ACCOUNTING -D KMEMSTATS -D PTRACE -D POOL_DEBUG -D CRYPTO -D SYSVMSG -D SYSVSEM -D SYSVSHM -D UVM_SWAP_ENCRYPT -D FFS -D FFS2 -D FFS_SOFTUPDATES -D UFS_DIRHASH -D QUOTA -D EXT2FS -D MFS -D NFSCLIENT -D NFSSERVER -D CD9660 -D UDF -D MSDOSFS -D FIFO -D FUSE -D SOCKET_SPLICE -D TCP_ECN -D TCP_SIGNATURE -D INET6 -D IPSEC -D PPP_BSDCOMP -D PPP_DEFLATE -D PIPEX -D MROUTING -D MPLS -D BOOT_CONFIG -D USER_PCICONF -D APERTURE -D MTRR -D NTFS -D HIBERNATE -D PCIVERBOSE -D USBVERBOSE -D WSDISPLAY_COMPAT_USL -D WSDISPLAY_COMPAT_RAWKBD -D WSDISPLAY_DEFAULTSCREENS=6 -D X86EMU -D ONEWIREVERBOSE -D MULTIPROCESSOR -D MAXUSERS=80 -D _KERNEL -D CONFIG_DRM_AMD_DC_DCN3_0 -O2 -Wno-pointer-sign -Wno-address-of-packed-member -Wno-constant-conversion -Wno-unused-but-set-variable -Wno-gnu-folding-constant -fdebug-compilation-dir=/usr/src/sys/arch/amd64/compile/GENERIC.MP/obj -ferror-limit 19 -fwrapv -D_RET_PROTECTOR -ret-protector -fgnuc-version=4.2.1 -vectorize-loops -vectorize-slp -fno-builtin-malloc -fno-builtin-calloc -fno-builtin-realloc -fno-builtin-valloc -fno-builtin-free -fno-builtin-strdup -fno-builtin-strndup -analyzer-output=html -faddrsig -o /usr/obj/sys/arch/amd64/compile/GENERIC.MP/scan-build/2022-01-12-131800-47421-1 -x c /usr/src/sys/dev/pci/if_iwx.c
1/*	$OpenBSD: if_iwx.c,v 1.133 2022/01/09 05:42:52 jsg Exp $	*/

3/*
* Copyright (c) 2014, 2016 genua gmbh <info@genua.de>
*   Author: Stefan Sperling <stsp@openbsd.org>
* Copyright (c) 2014 Fixup Software Ltd.
* Copyright (c) 2017, 2019, 2020 Stefan Sperling <stsp@openbsd.org>
*
* Permission to use, copy, modify, and distribute this software for any
* purpose with or without fee is hereby granted, provided that the above
* copyright notice and this permission notice appear in all copies.
*
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*/

22/*-
* Based on BSD-licensed source modules in the Linux iwlwifi driver,
* which were used as the reference documentation for this implementation.
*
******************************************************************************
*
* This file is provided under a dual BSD/GPLv2 license.  When using or
* redistributing this file, you may do so under either license.
*
* GPL LICENSE SUMMARY
*
* Copyright(c) 2017 Intel Deutschland GmbH
* Copyright(c) 2018 - 2019 Intel Corporation
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of version 2 of the GNU General Public License as
* published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
* General Public License for more details.
*
* BSD LICENSE
*
* Copyright(c) 2017 Intel Deutschland GmbH
* Copyright(c) 2018 - 2019 Intel Corporation
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
*  * Redistributions of source code must retain the above copyright
*    notice, this list of conditions and the following disclaimer.
*  * Redistributions in binary form must reproduce the above copyright
*    notice, this list of conditions and the following disclaimer in
*    the documentation and/or other materials provided with the
*    distribution.
*  * Neither the name Intel Corporation nor the names of its
*    contributors may be used to endorse or promote products derived
*    from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*
*****************************************************************************
*/

80/*-
* Copyright (c) 2007-2010 Damien Bergamini <damien.bergamini@free.fr>
*
* Permission to use, copy, modify, and distribute this software for any
* purpose with or without fee is hereby granted, provided that the above
* copyright notice and this permission notice appear in all copies.
*
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*/

96#include "bpfilter.h"

98#include <sys/param.h>
99#include <sys/conf.h>
100#include <sys/kernel.h>
101#include <sys/malloc.h>
102#include <sys/mbuf.h>
103#include <sys/mutex.h>
104#include <sys/proc.h>
105#include <sys/rwlock.h>
106#include <sys/socket.h>
107#include <sys/sockio.h>
108#include <sys/systm.h>
109#include <sys/endian.h>

111#include <sys/refcnt.h>
112#include <sys/task.h>
113#include <machine/bus.h>
114#include <machine/intr.h>

116#include <dev/pci/pcireg.h>
117#include <dev/pci/pcivar.h>
118#include <dev/pci/pcidevs.h>

120#if NBPFILTER1 > 0
121#include <net/bpf.h>
122#endif
123#include <net/if.h>
124#include <net/if_dl.h>
125#include <net/if_media.h>

127#include <netinet/in.h>
128#include <netinet/if_ether.h>

130#include <net80211/ieee80211_var.h>
131#include <net80211/ieee80211_radiotap.h>
132#include <net80211/ieee80211_priv.h> /* for SEQ_LT */
133#undef DPRINTF /* defined in ieee80211_priv.h */

135#define DEVNAME(_s)((_s)->sc_dev.dv_xname)	((_s)->sc_dev.dv_xname)

137#define IC2IFP(_ic_)(&(_ic_)->ic_ac.ac_if) (&(_ic_)->ic_ific_ac.ac_if)

139#define le16_to_cpup(_a_)(((__uint16_t)(*(const uint16_t *)(_a_)))) (le16toh(*(const uint16_t *)(_a_))((__uint16_t)(*(const uint16_t *)(_a_))))
140#define le32_to_cpup(_a_)(((__uint32_t)(*(const uint32_t *)(_a_)))) (le32toh(*(const uint32_t *)(_a_))((__uint32_t)(*(const uint32_t *)(_a_))))

142#ifdef IWX_DEBUG
143#define DPRINTF(x)do { ; } while (0)	do { if (iwx_debug > 0) printf x; } while (0)
144#define DPRINTFN(n, x)do { ; } while (0)	do { if (iwx_debug >= (n)) printf x; } while (0)
145int iwx_debug = 1;
146#else
147#define DPRINTF(x)do { ; } while (0)	do { ; } while (0)
148#define DPRINTFN(n, x)do { ; } while (0)	do { ; } while (0)
149#endif

151#include <dev/pci/if_iwxreg.h>
152#include <dev/pci/if_iwxvar.h>

154const uint8_t iwx_nvm_channels_8000[] = {
/* 2.4 GHz */
1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
/* 5 GHz */
36, 40, 44, 48, 52, 56, 60, 64, 68, 72, 76, 80, 84, 88, 92,
96, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144,
149, 153, 157, 161, 165, 169, 173, 177, 181
161};

163static const uint8_t iwx_nvm_channels_uhb[] = {
/* 2.4 GHz */
1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
/* 5 GHz */
36, 40, 44, 48, 52, 56, 60, 64, 68, 72, 76, 80, 84, 88, 92,
96, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144,
149, 153, 157, 161, 165, 169, 173, 177, 181,
/* 6-7 GHz */
1, 5, 9, 13, 17, 21, 25, 29, 33, 37, 41, 45, 49, 53, 57, 61, 65, 69,
73, 77, 81, 85, 89, 93, 97, 101, 105, 109, 113, 117, 121, 125, 129,
133, 137, 141, 145, 149, 153, 157, 161, 165, 169, 173, 177, 181, 185,
189, 193, 197, 201, 205, 209, 213, 217, 221, 225, 229, 233
175};

177#define IWX_NUM_2GHZ_CHANNELS14	14

179const struct iwx_rate {
uint16_t rate;
uint8_t plcp;
uint8_t ht_plcp;
183} iwx_rates[] = {
/* Legacy */		/* HT */
{   2,	IWX_RATE_1M_PLCP10,	IWX_RATE_HT_SISO_MCS_INV_PLCP0x20  },
{   4,	IWX_RATE_2M_PLCP20,	IWX_RATE_HT_SISO_MCS_INV_PLCP0x20 },
{  11,	IWX_RATE_5M_PLCP55,	IWX_RATE_HT_SISO_MCS_INV_PLCP0x20  },
{  22,	IWX_RATE_11M_PLCP110,	IWX_RATE_HT_SISO_MCS_INV_PLCP0x20 },
{  12,	IWX_RATE_6M_PLCP13,	IWX_RATE_HT_SISO_MCS_0_PLCP0 },
{  18,	IWX_RATE_9M_PLCP15,	IWX_RATE_HT_SISO_MCS_INV_PLCP0x20  },
{  24,	IWX_RATE_12M_PLCP5,	IWX_RATE_HT_SISO_MCS_1_PLCP1 },
{  26,	IWX_RATE_INVM_PLCP0xff,	IWX_RATE_HT_MIMO2_MCS_8_PLCP0x8 },
{  36,	IWX_RATE_18M_PLCP7,	IWX_RATE_HT_SISO_MCS_2_PLCP2 },
{  48,	IWX_RATE_24M_PLCP9,	IWX_RATE_HT_SISO_MCS_3_PLCP3 },
{  52,	IWX_RATE_INVM_PLCP0xff,	IWX_RATE_HT_MIMO2_MCS_9_PLCP0x9 },
{  72,	IWX_RATE_36M_PLCP11,	IWX_RATE_HT_SISO_MCS_4_PLCP4 },
{  78,	IWX_RATE_INVM_PLCP0xff,	IWX_RATE_HT_MIMO2_MCS_10_PLCP0xA },
{  96,	IWX_RATE_48M_PLCP1,	IWX_RATE_HT_SISO_MCS_5_PLCP5 },
{ 104,	IWX_RATE_INVM_PLCP0xff,	IWX_RATE_HT_MIMO2_MCS_11_PLCP0xB },
{ 108,	IWX_RATE_54M_PLCP3,	IWX_RATE_HT_SISO_MCS_6_PLCP6 },
{ 128,	IWX_RATE_INVM_PLCP0xff,	IWX_RATE_HT_SISO_MCS_7_PLCP7 },
{ 156,	IWX_RATE_INVM_PLCP0xff,	IWX_RATE_HT_MIMO2_MCS_12_PLCP0xC },
{ 208,	IWX_RATE_INVM_PLCP0xff,	IWX_RATE_HT_MIMO2_MCS_13_PLCP0xD },
{ 234,	IWX_RATE_INVM_PLCP0xff,	IWX_RATE_HT_MIMO2_MCS_14_PLCP0xE },
{ 260,	IWX_RATE_INVM_PLCP0xff,	IWX_RATE_HT_MIMO2_MCS_15_PLCP0xF },
206};
207#define IWX_RIDX_CCK0	0
208#define IWX_RIDX_OFDM4	4
209#define IWX_RIDX_MAX((sizeof((iwx_rates)) / sizeof((iwx_rates)[0]))-1)	(nitems(iwx_rates)(sizeof((iwx_rates)) / sizeof((iwx_rates)[0]))-1)
210#define IWX_RIDX_IS_CCK(_i_)((_i_) < 4) ((_i_) < IWX_RIDX_OFDM4)
211#define IWX_RIDX_IS_OFDM(_i_)((_i_) >= 4) ((_i_) >= IWX_RIDX_OFDM4)
212#define IWX_RVAL_IS_OFDM(_i_)((_i_) >= 12 && (_i_) != 22) ((_i_) >= 12 && (_i_) != 22)

214/* Convert an MCS index into an iwx_rates[] index. */
215const int iwx_mcs2ridx[] = {
IWX_RATE_MCS_0_INDEX,
IWX_RATE_MCS_1_INDEX,
IWX_RATE_MCS_2_INDEX,
IWX_RATE_MCS_3_INDEX,
IWX_RATE_MCS_4_INDEX,
IWX_RATE_MCS_5_INDEX,
IWX_RATE_MCS_6_INDEX,
IWX_RATE_MCS_7_INDEX,
IWX_RATE_MCS_8_INDEX,
IWX_RATE_MCS_9_INDEX,
IWX_RATE_MCS_10_INDEX,
IWX_RATE_MCS_11_INDEX,
IWX_RATE_MCS_12_INDEX,
IWX_RATE_MCS_13_INDEX,
IWX_RATE_MCS_14_INDEX,
IWX_RATE_MCS_15_INDEX,
232};

234uint8_t	iwx_lookup_cmd_ver(struct iwx_softc *, uint8_t, uint8_t);
235uint8_t	iwx_lookup_notif_ver(struct iwx_softc *, uint8_t, uint8_t);
236int	iwx_is_mimo_ht_plcp(uint8_t);
237int	iwx_is_mimo_mcs(int);
238int	iwx_store_cscheme(struct iwx_softc *, uint8_t *, size_t);
239int	iwx_alloc_fw_monitor_block(struct iwx_softc *, uint8_t, uint8_t);
240int	iwx_alloc_fw_monitor(struct iwx_softc *, uint8_t);
241int	iwx_apply_debug_destination(struct iwx_softc *);
242int	iwx_ctxt_info_init(struct iwx_softc *, const struct iwx_fw_sects *);
243void	iwx_ctxt_info_free_fw_img(struct iwx_softc *);
244void	iwx_ctxt_info_free_paging(struct iwx_softc *);
245int	iwx_init_fw_sec(struct iwx_softc *, const struct iwx_fw_sects *,
   struct iwx_context_info_dram *);
247void	iwx_fw_version_str(char *, size_t, uint32_t, uint32_t, uint32_t);
248int	iwx_firmware_store_section(struct iwx_softc *, enum iwx_ucode_type,
   uint8_t *, size_t);
250int	iwx_set_default_calib(struct iwx_softc *, const void *);
251void	iwx_fw_info_free(struct iwx_fw_info *);
252int	iwx_read_firmware(struct iwx_softc *);
253uint32_t iwx_read_prph_unlocked(struct iwx_softc *, uint32_t);
254uint32_t iwx_read_prph(struct iwx_softc *, uint32_t);
255void	iwx_write_prph_unlocked(struct iwx_softc *, uint32_t, uint32_t);
256void	iwx_write_prph(struct iwx_softc *, uint32_t, uint32_t);
257int	iwx_read_mem(struct iwx_softc *, uint32_t, void *, int);
258int	iwx_write_mem(struct iwx_softc *, uint32_t, const void *, int);
259int	iwx_write_mem32(struct iwx_softc *, uint32_t, uint32_t);
260int	iwx_poll_bit(struct iwx_softc *, int, uint32_t, uint32_t, int);
261int	iwx_nic_lock(struct iwx_softc *);
262void	iwx_nic_assert_locked(struct iwx_softc *);
263void	iwx_nic_unlock(struct iwx_softc *);
264int	iwx_set_bits_mask_prph(struct iwx_softc *, uint32_t, uint32_t,
   uint32_t);
266int	iwx_set_bits_prph(struct iwx_softc *, uint32_t, uint32_t);
267int	iwx_clear_bits_prph(struct iwx_softc *, uint32_t, uint32_t);
268int	iwx_dma_contig_alloc(bus_dma_tag_t, struct iwx_dma_info *, bus_size_t,
   bus_size_t);
270void	iwx_dma_contig_free(struct iwx_dma_info *);
271int	iwx_alloc_rx_ring(struct iwx_softc *, struct iwx_rx_ring *);
272void	iwx_disable_rx_dma(struct iwx_softc *);
273void	iwx_reset_rx_ring(struct iwx_softc *, struct iwx_rx_ring *);
274void	iwx_free_rx_ring(struct iwx_softc *, struct iwx_rx_ring *);
275int	iwx_alloc_tx_ring(struct iwx_softc *, struct iwx_tx_ring *, int);
276void	iwx_reset_tx_ring(struct iwx_softc *, struct iwx_tx_ring *);
277void	iwx_free_tx_ring(struct iwx_softc *, struct iwx_tx_ring *);
278void	iwx_enable_rfkill_int(struct iwx_softc *);
279int	iwx_check_rfkill(struct iwx_softc *);
280void	iwx_enable_interrupts(struct iwx_softc *);
281void	iwx_enable_fwload_interrupt(struct iwx_softc *);
282void	iwx_restore_interrupts(struct iwx_softc *);
283void	iwx_disable_interrupts(struct iwx_softc *);
284void	iwx_ict_reset(struct iwx_softc *);
285int	iwx_set_hw_ready(struct iwx_softc *);
286int	iwx_prepare_card_hw(struct iwx_softc *);
287int	iwx_force_power_gating(struct iwx_softc *);
288void	iwx_apm_config(struct iwx_softc *);
289int	iwx_apm_init(struct iwx_softc *);
290void	iwx_apm_stop(struct iwx_softc *);
291int	iwx_allow_mcast(struct iwx_softc *);
292void	iwx_init_msix_hw(struct iwx_softc *);
293void	iwx_conf_msix_hw(struct iwx_softc *, int);
294int	iwx_clear_persistence_bit(struct iwx_softc *);
295int	iwx_start_hw(struct iwx_softc *);
296void	iwx_stop_device(struct iwx_softc *);
297void	iwx_nic_config(struct iwx_softc *);
298int	iwx_nic_rx_init(struct iwx_softc *);
299int	iwx_nic_init(struct iwx_softc *);
300int	iwx_enable_txq(struct iwx_softc *, int, int, int, int);
301int	iwx_disable_txq(struct iwx_softc *sc, int, int, uint8_t);
302void	iwx_post_alive(struct iwx_softc *);
303int	iwx_schedule_session_protection(struct iwx_softc *, struct iwx_node *,
   uint32_t);
305void	iwx_init_channel_map(struct iwx_softc *, uint16_t *, uint32_t *, int);
306void	iwx_setup_ht_rates(struct iwx_softc *);
307int	iwx_mimo_enabled(struct iwx_softc *);
308void	iwx_mac_ctxt_task(void *);
309void	iwx_phy_ctxt_task(void *);
310void	iwx_updatechan(struct ieee80211com *);
311void	iwx_updateprot(struct ieee80211com *);
312void	iwx_updateslot(struct ieee80211com *);
313void	iwx_updateedca(struct ieee80211com *);
314void	iwx_init_reorder_buffer(struct iwx_reorder_buffer *, uint16_t,
   uint16_t);
316void	iwx_clear_reorder_buffer(struct iwx_softc *, struct iwx_rxba_data *);
317int	iwx_ampdu_rx_start(struct ieee80211com *, struct ieee80211_node *,
   uint8_t);
319void	iwx_ampdu_rx_stop(struct ieee80211com *, struct ieee80211_node *,
   uint8_t);
321int	iwx_ampdu_tx_start(struct ieee80211com *, struct ieee80211_node *,
   uint8_t);
323void	iwx_rx_ba_session_expired(void *);
324void	iwx_rx_bar_frame_release(struct iwx_softc *, struct iwx_rx_packet *,
   struct mbuf_list *);
326void	iwx_reorder_timer_expired(void *);
327void	iwx_sta_rx_agg(struct iwx_softc *, struct ieee80211_node *, uint8_t,
   uint16_t, uint16_t, int, int);
329void	iwx_sta_tx_agg_start(struct iwx_softc *, struct ieee80211_node *,
   uint8_t);
331void	iwx_ba_task(void *);

333int	iwx_set_mac_addr_from_csr(struct iwx_softc *, struct iwx_nvm_data *);
334int	iwx_is_valid_mac_addr(const uint8_t *);
335int	iwx_nvm_get(struct iwx_softc *);
336int	iwx_load_firmware(struct iwx_softc *);
337int	iwx_start_fw(struct iwx_softc *);
338int	iwx_send_tx_ant_cfg(struct iwx_softc *, uint8_t);
339int	iwx_send_phy_cfg_cmd(struct iwx_softc *);
340int	iwx_load_ucode_wait_alive(struct iwx_softc *);
341int	iwx_send_dqa_cmd(struct iwx_softc *);
342int	iwx_run_init_mvm_ucode(struct iwx_softc *, int);
343int	iwx_config_ltr(struct iwx_softc *);
344void	iwx_update_rx_desc(struct iwx_softc *, struct iwx_rx_ring *, int);
345int	iwx_rx_addbuf(struct iwx_softc *, int, int);
346int	iwx_rxmq_get_signal_strength(struct iwx_softc *, struct iwx_rx_mpdu_desc *);
347void	iwx_rx_rx_phy_cmd(struct iwx_softc *, struct iwx_rx_packet *,
   struct iwx_rx_data *);
349int	iwx_get_noise(const struct iwx_statistics_rx_non_phy *);
350int	iwx_rx_hwdecrypt(struct iwx_softc *, struct mbuf *, uint32_t,
   struct ieee80211_rxinfo *);
352int	iwx_ccmp_decap(struct iwx_softc *, struct mbuf *,
   struct ieee80211_node *, struct ieee80211_rxinfo *);
354void	iwx_rx_frame(struct iwx_softc *, struct mbuf *, int, uint32_t, int, int,
   uint32_t, struct ieee80211_rxinfo *, struct mbuf_list *);
356void	iwx_clear_tx_desc(struct iwx_softc *, struct iwx_tx_ring *, int);
357void	iwx_txd_done(struct iwx_softc *, struct iwx_tx_data *);
358void	iwx_txq_advance(struct iwx_softc *, struct iwx_tx_ring *, int);
359void	iwx_rx_tx_cmd(struct iwx_softc *, struct iwx_rx_packet *,
   struct iwx_rx_data *);
361void	iwx_clear_oactive(struct iwx_softc *, struct iwx_tx_ring *);
362void	iwx_rx_bmiss(struct iwx_softc *, struct iwx_rx_packet *,
   struct iwx_rx_data *);
364int	iwx_binding_cmd(struct iwx_softc *, struct iwx_node *, uint32_t);
365int	iwx_phy_ctxt_cmd_uhb_v3(struct iwx_softc *, struct iwx_phy_ctxt *, uint8_t,
   uint8_t, uint32_t, uint8_t);
367int	iwx_phy_ctxt_cmd_v3(struct iwx_softc *, struct iwx_phy_ctxt *, uint8_t,
   uint8_t, uint32_t, uint8_t);
369int	iwx_phy_ctxt_cmd(struct iwx_softc *, struct iwx_phy_ctxt *, uint8_t,
   uint8_t, uint32_t, uint32_t, uint8_t);
371int	iwx_send_cmd(struct iwx_softc *, struct iwx_host_cmd *);
372int	iwx_send_cmd_pdu(struct iwx_softc *, uint32_t, uint32_t, uint16_t,
   const void *);
374int	iwx_send_cmd_status(struct iwx_softc *, struct iwx_host_cmd *,
   uint32_t *);
376int	iwx_send_cmd_pdu_status(struct iwx_softc *, uint32_t, uint16_t,
   const void *, uint32_t *);
378void	iwx_free_resp(struct iwx_softc *, struct iwx_host_cmd *);
379void	iwx_cmd_done(struct iwx_softc *, int, int, int);
380const struct iwx_rate *iwx_tx_fill_cmd(struct iwx_softc *, struct iwx_node *,
   struct ieee80211_frame *, struct iwx_tx_cmd_gen2 *);
382void	iwx_tx_update_byte_tbl(struct iwx_tx_ring *, int, uint16_t, uint16_t);
383int	iwx_tx(struct iwx_softc *, struct mbuf *, struct ieee80211_node *);
384int	iwx_flush_sta_tids(struct iwx_softc *, int, uint16_t);
385int	iwx_wait_tx_queues_empty(struct iwx_softc *);
386int	iwx_drain_sta(struct iwx_softc *sc, struct iwx_node *, int);
387int	iwx_flush_sta(struct iwx_softc *, struct iwx_node *);
388int	iwx_beacon_filter_send_cmd(struct iwx_softc *,
   struct iwx_beacon_filter_cmd *);
390int	iwx_update_beacon_abort(struct iwx_softc *, struct iwx_node *, int);
391void	iwx_power_build_cmd(struct iwx_softc *, struct iwx_node *,
   struct iwx_mac_power_cmd *);
393int	iwx_power_mac_update_mode(struct iwx_softc *, struct iwx_node *);
394int	iwx_power_update_device(struct iwx_softc *);
395int	iwx_enable_beacon_filter(struct iwx_softc *, struct iwx_node *);
396int	iwx_disable_beacon_filter(struct iwx_softc *);
397int	iwx_add_sta_cmd(struct iwx_softc *, struct iwx_node *, int);
398int	iwx_rm_sta_cmd(struct iwx_softc *, struct iwx_node *);
399int	iwx_rm_sta(struct iwx_softc *, struct iwx_node *);
400int	iwx_fill_probe_req(struct iwx_softc *, struct iwx_scan_probe_req *);
401int	iwx_config_umac_scan_reduced(struct iwx_softc *);
402uint16_t iwx_scan_umac_flags_v2(struct iwx_softc *, int);
403void	iwx_scan_umac_dwell_v10(struct iwx_softc *,
   struct iwx_scan_general_params_v10 *, int);
405void	iwx_scan_umac_fill_general_p_v10(struct iwx_softc *,
   struct iwx_scan_general_params_v10 *, uint16_t, int);
407void	iwx_scan_umac_fill_ch_p_v6(struct iwx_softc *,
   struct iwx_scan_channel_params_v6 *, uint32_t, int, int);
409int	iwx_umac_scan_v14(struct iwx_softc *, int);
410void	iwx_mcc_update(struct iwx_softc *, struct iwx_mcc_chub_notif *);
411uint8_t	iwx_ridx2rate(struct ieee80211_rateset *, int);
412int	iwx_rval2ridx(int);
413void	iwx_ack_rates(struct iwx_softc *, struct iwx_node *, int *, int *);
414void	iwx_mac_ctxt_cmd_common(struct iwx_softc *, struct iwx_node *,
   struct iwx_mac_ctx_cmd *, uint32_t);
416void	iwx_mac_ctxt_cmd_fill_sta(struct iwx_softc *, struct iwx_node *,
   struct iwx_mac_data_sta *, int);
418int	iwx_mac_ctxt_cmd(struct iwx_softc *, struct iwx_node *, uint32_t, int);
419int	iwx_clear_statistics(struct iwx_softc *);
420void	iwx_add_task(struct iwx_softc *, struct taskq *, struct task *);
421void	iwx_del_task(struct iwx_softc *, struct taskq *, struct task *);
422int	iwx_scan(struct iwx_softc *);
423int	iwx_bgscan(struct ieee80211com *);
424void	iwx_bgscan_done(struct ieee80211com *,
   struct ieee80211_node_switch_bss_arg *, size_t);
426void	iwx_bgscan_done_task(void *);
427int	iwx_umac_scan_abort(struct iwx_softc *);
428int	iwx_scan_abort(struct iwx_softc *);
429int	iwx_enable_mgmt_queue(struct iwx_softc *);
430int	iwx_rs_rval2idx(uint8_t);
431uint16_t iwx_rs_ht_rates(struct iwx_softc *, struct ieee80211_node *, int);
432int	iwx_rs_init(struct iwx_softc *, struct iwx_node *);
433int	iwx_enable_data_tx_queues(struct iwx_softc *);
434int	iwx_phy_ctxt_update(struct iwx_softc *, struct iwx_phy_ctxt *,
   struct ieee80211_channel *, uint8_t, uint8_t, uint32_t, uint8_t);
436int	iwx_auth(struct iwx_softc *);
437int	iwx_deauth(struct iwx_softc *);
438int	iwx_run(struct iwx_softc *);
439int	iwx_run_stop(struct iwx_softc *);
440struct ieee80211_node *iwx_node_alloc(struct ieee80211com *);
441int	iwx_set_key(struct ieee80211com *, struct ieee80211_node *,
   struct ieee80211_key *);
443void	iwx_setkey_task(void *);
444void	iwx_delete_key(struct ieee80211com *,
   struct ieee80211_node *, struct ieee80211_key *);
446int	iwx_media_change(struct ifnet *);
447void	iwx_newstate_task(void *);
448int	iwx_newstate(struct ieee80211com *, enum ieee80211_state, int);
449void	iwx_endscan(struct iwx_softc *);
450void	iwx_fill_sf_command(struct iwx_softc *, struct iwx_sf_cfg_cmd *,
   struct ieee80211_node *);
452int	iwx_sf_config(struct iwx_softc *, int);
453int	iwx_send_bt_init_conf(struct iwx_softc *);
454int	iwx_send_soc_conf(struct iwx_softc *);
455int	iwx_send_update_mcc_cmd(struct iwx_softc *, const char *);
456int	iwx_send_temp_report_ths_cmd(struct iwx_softc *);
457int	iwx_init_hw(struct iwx_softc *);
458int	iwx_init(struct ifnet *);
459void	iwx_start(struct ifnet *);
460void	iwx_stop(struct ifnet *);
461void	iwx_watchdog(struct ifnet *);
462int	iwx_ioctl(struct ifnet *, u_long, caddr_t);
463const char *iwx_desc_lookup(uint32_t);
464void	iwx_nic_error(struct iwx_softc *);
465void	iwx_dump_driver_status(struct iwx_softc *);
466void	iwx_nic_umac_error(struct iwx_softc *);
467int	iwx_detect_duplicate(struct iwx_softc *, struct mbuf *,
   struct iwx_rx_mpdu_desc *, struct ieee80211_rxinfo *);
469int	iwx_is_sn_less(uint16_t, uint16_t, uint16_t);
470void	iwx_release_frames(struct iwx_softc *, struct ieee80211_node *,
   struct iwx_rxba_data *, struct iwx_reorder_buffer *, uint16_t,
   struct mbuf_list *);
473int	iwx_oldsn_workaround(struct iwx_softc *, struct ieee80211_node *,
   int, struct iwx_reorder_buffer *, uint32_t, uint32_t);
475int	iwx_rx_reorder(struct iwx_softc *, struct mbuf *, int,
   struct iwx_rx_mpdu_desc *, int, int, uint32_t,
   struct ieee80211_rxinfo *, struct mbuf_list *);
478void	iwx_rx_mpdu_mq(struct iwx_softc *, struct mbuf *, void *, size_t,
   struct mbuf_list *);
480int	iwx_rx_pkt_valid(struct iwx_rx_packet *);
481void	iwx_rx_pkt(struct iwx_softc *, struct iwx_rx_data *,
   struct mbuf_list *);
483void	iwx_notif_intr(struct iwx_softc *);
484int	iwx_intr(void *);
485int	iwx_intr_msix(void *);
486int	iwx_match(struct device *, void *, void *);
487int	iwx_preinit(struct iwx_softc *);
488void	iwx_attach_hook(struct device *);
489void	iwx_attach(struct device *, struct device *, void *);
490void	iwx_init_task(void *);
491int	iwx_activate(struct device *, int);
492void	iwx_resume(struct iwx_softc *);
493int	iwx_wakeup(struct iwx_softc *);

495#if NBPFILTER1 > 0
496void	iwx_radiotap_attach(struct iwx_softc *);
497#endif

499uint8_t
500iwx_lookup_cmd_ver(struct iwx_softc *sc, uint8_t grp, uint8_t cmd)
501{
const struct iwx_fw_cmd_version *entry;
int i;

for (i = 0; i < sc->n_cmd_versions; i++) {
entry = &sc->cmd_versions[i];
if (entry->group == grp && entry->cmd == cmd)
	return entry->cmd_ver;
}

return IWX_FW_CMD_VER_UNKNOWN99;
512}

514uint8_t
515iwx_lookup_notif_ver(struct iwx_softc *sc, uint8_t grp, uint8_t cmd)
516{
const struct iwx_fw_cmd_version *entry;
int i;

for (i = 0; i < sc->n_cmd_versions; i++) {
entry = &sc->cmd_versions[i];
if (entry->group == grp && entry->cmd == cmd)
	return entry->notif_ver;
}

return IWX_FW_CMD_VER_UNKNOWN99;
527}

529int
530iwx_is_mimo_ht_plcp(uint8_t ht_plcp)
531{
return (ht_plcp != IWX_RATE_HT_SISO_MCS_INV_PLCP0x20 &&
   (ht_plcp & IWX_RATE_HT_MCS_NSS_MSK(3 << 3)));
534}

536int
537iwx_is_mimo_mcs(int mcs)
538{
int ridx = iwx_mcs2ridx[mcs];
return iwx_is_mimo_ht_plcp(iwx_rates[ridx].ht_plcp);

542}

544int
545iwx_store_cscheme(struct iwx_softc *sc, uint8_t *data, size_t dlen)
546{
struct iwx_fw_cscheme_list *l = (void *)data;

if (dlen < sizeof(*l) ||
   dlen < sizeof(l->size) + l->size * sizeof(*l->cs))
return EINVAL22;

/* we don't actually store anything for now, always use s/w crypto */

return 0;
556}

558int
559iwx_ctxt_info_alloc_dma(struct iwx_softc *sc,
  const struct iwx_fw_onesect *sec, struct iwx_dma_info *dram)
561{
int err = iwx_dma_contig_alloc(sc->sc_dmat, dram, sec->fws_len, 0);
if (err) {
printf("%s: could not allocate context info DMA memory\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
return err;
}

memcpy(dram->vaddr, sec->fws_data, sec->fws_len)__builtin_memcpy((dram->vaddr), (sec->fws_data), (sec->
fws_len));

return 0;
572}

574void iwx_ctxt_info_free_paging(struct iwx_softc *sc)
575{
struct iwx_self_init_dram *dram = &sc->init_dram;
int i;

if (!dram->paging)
return;

/* free paging*/
for (i = 0; i < dram->paging_cnt; i++)
iwx_dma_contig_free(&dram->paging[i]);

free(dram->paging, M_DEVBUF2, dram->paging_cnt * sizeof(*dram->paging));
dram->paging_cnt = 0;
dram->paging = NULL((void *)0);
589}

591int
592iwx_get_num_sections(const struct iwx_fw_sects *fws, int start)
593{
int i = 0;

while (start < fws->fw_count &&
      fws->fw_sect[start].fws_devoff != IWX_CPU1_CPU2_SEPARATOR_SECTION0xFFFFCCCC &&
      fws->fw_sect[start].fws_devoff != IWX_PAGING_SEPARATOR_SECTION0xAAAABBBB) {
start++;
i++;
}

return i;
604}

606int
607iwx_init_fw_sec(struct iwx_softc *sc, const struct iwx_fw_sects *fws,
  struct iwx_context_info_dram *ctxt_dram)
609{
struct iwx_self_init_dram *dram = &sc->init_dram;
int i, ret, fw_cnt = 0;

KASSERT(dram->paging == NULL)((dram->paging == ((void *)0)) ? (void)0 : __assert("diagnostic "
, "/usr/src/sys/dev/pci/if_iwx.c", 613, "dram->paging == NULL"
));

dram->lmac_cnt = iwx_get_num_sections(fws, 0);
/* add 1 due to separator */
dram->umac_cnt = iwx_get_num_sections(fws, dram->lmac_cnt + 1);
/* add 2 due to separators */
dram->paging_cnt = iwx_get_num_sections(fws,
   dram->lmac_cnt + dram->umac_cnt + 2);

dram->fw = mallocarray(dram->umac_cnt + dram->lmac_cnt,
   sizeof(*dram->fw), M_DEVBUF2,  M_ZERO0x0008 | M_NOWAIT0x0002);
if (!dram->fw) {
printf("%s: could not allocate memory for firmware sections\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
return ENOMEM12;
}

dram->paging = mallocarray(dram->paging_cnt, sizeof(*dram->paging),
   M_DEVBUF2, M_ZERO0x0008 | M_NOWAIT0x0002);
if (!dram->paging) {
printf("%s: could not allocate memory for firmware paging\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
return ENOMEM12;
}

/* initialize lmac sections */
for (i = 0; i < dram->lmac_cnt; i++) {
ret = iwx_ctxt_info_alloc_dma(sc, &fws->fw_sect[i],
				   &dram->fw[fw_cnt]);
if (ret)
	return ret;
ctxt_dram->lmac_img[i] =
	htole64(dram->fw[fw_cnt].paddr)((__uint64_t)(dram->fw[fw_cnt].paddr));
DPRINTF(("%s: firmware LMAC section %d at 0x%llx size %lld\n", __func__, i,do { ; } while (0)
    (unsigned long long)dram->fw[fw_cnt].paddr,do { ; } while (0)
    (unsigned long long)dram->fw[fw_cnt].size))do { ; } while (0);
fw_cnt++;
}

/* initialize umac sections */
for (i = 0; i < dram->umac_cnt; i++) {
/* access FW with +1 to make up for lmac separator */
ret = iwx_ctxt_info_alloc_dma(sc,
    &fws->fw_sect[fw_cnt + 1], &dram->fw[fw_cnt]);
if (ret)
	return ret;
ctxt_dram->umac_img[i] =
	htole64(dram->fw[fw_cnt].paddr)((__uint64_t)(dram->fw[fw_cnt].paddr));
DPRINTF(("%s: firmware UMAC section %d at 0x%llx size %lld\n", __func__, i,do { ; } while (0)
	(unsigned long long)dram->fw[fw_cnt].paddr,do { ; } while (0)
	(unsigned long long)dram->fw[fw_cnt].size))do { ; } while (0);
fw_cnt++;
}

/*
* Initialize paging.
* Paging memory isn't stored in dram->fw as the umac and lmac - it is
* stored separately.
* This is since the timing of its release is different -
* while fw memory can be released on alive, the paging memory can be
* freed only when the device goes down.
* Given that, the logic here in accessing the fw image is a bit
* different - fw_cnt isn't changing so loop counter is added to it.
*/
for (i = 0; i < dram->paging_cnt; i++) {
/* access FW with +2 to make up for lmac & umac separators */
int fw_idx = fw_cnt + i + 2;

ret = iwx_ctxt_info_alloc_dma(sc,
    &fws->fw_sect[fw_idx], &dram->paging[i]);
if (ret)
	return ret;

ctxt_dram->virtual_img[i] = htole64(dram->paging[i].paddr)((__uint64_t)(dram->paging[i].paddr));
DPRINTF(("%s: firmware paging section %d at 0x%llx size %lld\n", __func__, i,do { ; } while (0)
    (unsigned long long)dram->paging[i].paddr,do { ; } while (0)
    (unsigned long long)dram->paging[i].size))do { ; } while (0);
}

return 0;
693}
   
695void
696iwx_fw_version_str(char *buf, size_t bufsize,
  uint32_t major, uint32_t minor, uint32_t api)
698{
/*
* Starting with major version 35 the Linux driver prints the minor
* version in hexadecimal.
*/
if (major >= 35)
snprintf(buf, bufsize, "%u.%08x.%u", major, minor, api);
else
snprintf(buf, bufsize, "%u.%u.%u", major, minor, api);
707}

709int
710iwx_alloc_fw_monitor_block(struct iwx_softc *sc, uint8_t max_power,
  uint8_t min_power)
712{
struct iwx_dma_info *fw_mon = &sc->fw_mon;
uint32_t size = 0;
uint8_t power;
int err;
1
'err' declared without an initial value→

if (fw_mon->size)
2
←
Assuming field 'size' is 0→
3
←
Taking false branch→
return 0;

for (power = max_power; power >= min_power; power--) {
4
←
Assuming 'power' is < 'min_power'→
5
←
Loop condition is false. Execution continues on line 733→
size = (1 << power);

err = iwx_dma_contig_alloc(sc->sc_dmat, fw_mon, size, 0);
if (err)
	continue;

DPRINTF(("%s: allocated 0x%08x bytes for firmware monitor.\n",do { ; } while (0)
	 DEVNAME(sc), size))do { ; } while (0);
break;
}

if (err) {
6
←
Branch condition evaluates to a garbage value
fw_mon->size = 0;
return err;
}

if (power != max_power)
DPRINTF(("%s: Sorry - debug buffer is only %luK while you requested %luK\n",do { ; } while (0)
	DEVNAME(sc), (unsigned long)(1 << (power - 10)),do { ; } while (0)
	(unsigned long)(1 << (max_power - 10))))do { ; } while (0);

return 0;
744}

746int
747iwx_alloc_fw_monitor(struct iwx_softc *sc, uint8_t max_power)
748{
if (!max_power) {
/* default max_power is maximum */
max_power = 26;
} else {
max_power += 11;
}

if (max_power > 26) {
 DPRINTF(("%s: External buffer size for monitor is too big %d, "do { ; } while (0)
     "check the FW TLV\n", DEVNAME(sc), max_power))do { ; } while (0);
return 0;
}

if (sc->fw_mon.size)
return 0;

return iwx_alloc_fw_monitor_block(sc, max_power, 11);
766}

768int
769iwx_apply_debug_destination(struct iwx_softc *sc)
770{
struct iwx_fw_dbg_dest_tlv_v1 *dest_v1;
int i, err;
uint8_t mon_mode, size_power, base_shift, end_shift;
uint32_t base_reg, end_reg;

dest_v1 = sc->sc_fw.dbg_dest_tlv_v1;
mon_mode = dest_v1->monitor_mode;
size_power = dest_v1->size_power;
base_reg = le32toh(dest_v1->base_reg)((__uint32_t)(dest_v1->base_reg));
end_reg = le32toh(dest_v1->end_reg)((__uint32_t)(dest_v1->end_reg));
base_shift = dest_v1->base_shift;
end_shift = dest_v1->end_shift;

DPRINTF(("%s: applying debug destination %d\n", DEVNAME(sc), mon_mode))do { ; } while (0);

if (mon_mode == EXTERNAL_MODE) {
err = iwx_alloc_fw_monitor(sc, size_power);
if (err)
	return err;
}

if (!iwx_nic_lock(sc))
return EBUSY16;

for (i = 0; i < sc->sc_fw.n_dest_reg; i++) {
uint32_t addr, val;
uint8_t op;

addr = le32toh(dest_v1->reg_ops[i].addr)((__uint32_t)(dest_v1->reg_ops[i].addr));
val = le32toh(dest_v1->reg_ops[i].val)((__uint32_t)(dest_v1->reg_ops[i].val));
op = dest_v1->reg_ops[i].op;

DPRINTF(("%s: op=%u addr=%u val=%u\n", __func__, op, addr, val))do { ; } while (0);
switch (op) {
case CSR_ASSIGN:
	IWX_WRITE(sc, addr, val)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((addr)), ((val
))));
	break;
case CSR_SETBIT:
	IWX_SETBITS(sc, addr, (1 << val))(((sc)->sc_st)->write_4(((sc)->sc_sh), ((addr)), (((
((sc)->sc_st)->read_4(((sc)->sc_sh), ((addr)))) | ((
<< val))))));
	break;
case CSR_CLEARBIT:
	IWX_CLRBITS(sc, addr, (1 << val))(((sc)->sc_st)->write_4(((sc)->sc_sh), ((addr)), (((
((sc)->sc_st)->read_4(((sc)->sc_sh), ((addr)))) &
 ~((1 << val))))));
	break;
case PRPH_ASSIGN:
	iwx_write_prph(sc, addr, val);
	break;
case PRPH_SETBIT:
	err = iwx_set_bits_prph(sc, addr, (1 << val));
	if (err)
		return err;
	break;
case PRPH_CLEARBIT:
	err = iwx_clear_bits_prph(sc, addr, (1 << val));
	if (err)
		return err;
	break;
case PRPH_BLOCKBIT:
	if (iwx_read_prph(sc, addr) & (1 << val))
		goto monitor;
	break;
default:
	DPRINTF(("%s: FW debug - unknown OP %d\n",do { ; } while (0)
	    DEVNAME(sc), op))do { ; } while (0);
	break;
}
}

838monitor:
if (mon_mode == EXTERNAL_MODE && sc->fw_mon.size) {
iwx_write_prph(sc, le32toh(base_reg)((__uint32_t)(base_reg)),
    sc->fw_mon.paddr >> base_shift);
iwx_write_prph(sc, end_reg,
    (sc->fw_mon.paddr + sc->fw_mon.size - 256)
    >> end_shift);
}

iwx_nic_unlock(sc);
return 0;
849}

851int
852iwx_ctxt_info_init(struct iwx_softc *sc, const struct iwx_fw_sects *fws)
853{
struct iwx_context_info *ctxt_info;
struct iwx_context_info_rbd_cfg *rx_cfg;
uint32_t control_flags = 0, rb_size;
uint64_t paddr;
int err;

ctxt_info = sc->ctxt_info_dma.vaddr;

ctxt_info->version.version = 0;
ctxt_info->version.mac_id =
htole16((uint16_t)IWX_READ(sc, IWX_CSR_HW_REV))((__uint16_t)((uint16_t)(((sc)->sc_st)->read_4(((sc)->
sc_sh), (((0x028)))))));
/* size is in DWs */
ctxt_info->version.size = htole16(sizeof(*ctxt_info) / 4)((__uint16_t)(sizeof(*ctxt_info) / 4));

if (sc->sc_device_family >= IWX_DEVICE_FAMILY_225602)
rb_size = IWX_CTXT_INFO_RB_SIZE_2K;
else
rb_size = IWX_CTXT_INFO_RB_SIZE_4K;

KASSERT(IWX_RX_QUEUE_CB_SIZE(IWX_MQ_RX_TABLE_SIZE) < 0xF)((((sizeof(512) <= 4) ? (fls(512) - 1) : (flsl(512) - 1)) <
 0xF) ? (void)0 : __assert("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c"
, 873, "IWX_RX_QUEUE_CB_SIZE(IWX_MQ_RX_TABLE_SIZE) < 0xF")
);
control_flags = IWX_CTXT_INFO_TFD_FORMAT_LONG |
	(IWX_RX_QUEUE_CB_SIZE(IWX_MQ_RX_TABLE_SIZE)((sizeof(512) <= 4) ? (fls(512) - 1) : (flsl(512) - 1)) <<
	 IWX_CTXT_INFO_RB_CB_SIZE_POS) |
	(rb_size << IWX_CTXT_INFO_RB_SIZE_POS);
ctxt_info->control.control_flags = htole32(control_flags)((__uint32_t)(control_flags));

/* initialize RX default queue */
rx_cfg = &ctxt_info->rbd_cfg;
rx_cfg->free_rbd_addr = htole64(sc->rxq.free_desc_dma.paddr)((__uint64_t)(sc->rxq.free_desc_dma.paddr));
rx_cfg->used_rbd_addr = htole64(sc->rxq.used_desc_dma.paddr)((__uint64_t)(sc->rxq.used_desc_dma.paddr));
rx_cfg->status_wr_ptr = htole64(sc->rxq.stat_dma.paddr)((__uint64_t)(sc->rxq.stat_dma.paddr));

/* initialize TX command queue */
ctxt_info->hcmd_cfg.cmd_queue_addr =
htole64(sc->txq[IWX_DQA_CMD_QUEUE].desc_dma.paddr)((__uint64_t)(sc->txq[0].desc_dma.paddr));
ctxt_info->hcmd_cfg.cmd_queue_size =
IWX_TFD_QUEUE_CB_SIZE(IWX_TX_RING_COUNT)(((sizeof((256)) <= 4) ? (fls((256)) - 1) : (flsl((256)) -
 1)) - 3);

/* allocate ucode sections in dram and set addresses */
err = iwx_init_fw_sec(sc, fws, &ctxt_info->dram);
if (err) {
iwx_ctxt_info_free_fw_img(sc);
return err;
}

/* Configure debug, if exists */
if (sc->sc_fw.dbg_dest_tlv_v1) {
err = iwx_apply_debug_destination(sc);
if (err) {
	iwx_ctxt_info_free_fw_img(sc);
	return err;
}
}

/*
* Write the context info DMA base address. The device expects a
* 64-bit address but a simple bus_space_write_8 to this register
* won't work on some devices, such as the AX201.
*/
paddr = sc->ctxt_info_dma.paddr;
IWX_WRITE(sc, IWX_CSR_CTXT_INFO_BA, paddr & 0xffffffff)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((0x40)), ((paddr
 & 0xffffffff))));
IWX_WRITE(sc, IWX_CSR_CTXT_INFO_BA + 4, paddr >> 32)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((0x40 + 4)),
 ((paddr >> 32))));

/* kick FW self load */
if (!iwx_nic_lock(sc)) {
iwx_ctxt_info_free_fw_img(sc);
return EBUSY16;
}
iwx_write_prph(sc, IWX_UREG_CPU_INIT_RUN(0xa05c44), 1);
iwx_nic_unlock(sc);

/* Context info will be released upon alive or failure to get one */

return 0;
928}

930void
931iwx_ctxt_info_free_fw_img(struct iwx_softc *sc)
932{
struct iwx_self_init_dram *dram = &sc->init_dram;
int i;

if (!dram->fw)
return;

for (i = 0; i < dram->lmac_cnt + dram->umac_cnt; i++)
iwx_dma_contig_free(&dram->fw[i]);

free(dram->fw, M_DEVBUF2,
   (dram->lmac_cnt + dram->umac_cnt) * sizeof(*dram->fw));
dram->lmac_cnt = 0;
dram->umac_cnt = 0;
dram->fw = NULL((void *)0);
947}

949int
950iwx_firmware_store_section(struct iwx_softc *sc, enum iwx_ucode_type type,
  uint8_t *data, size_t dlen)
952{
struct iwx_fw_sects *fws;
struct iwx_fw_onesect *fwone;

if (type >= IWX_UCODE_TYPE_MAX)
return EINVAL22;
if (dlen < sizeof(uint32_t))
return EINVAL22;

fws = &sc->sc_fw.fw_sects[type];
DPRINTF(("%s: ucode type %d section %d\n", DEVNAME(sc), type, fws->fw_count))do { ; } while (0);
if (fws->fw_count >= IWX_UCODE_SECT_MAX49)
return EINVAL22;

fwone = &fws->fw_sect[fws->fw_count];

/* first 32bit are device load offset */
memcpy(&fwone->fws_devoff, data, sizeof(uint32_t))__builtin_memcpy((&fwone->fws_devoff), (data), (sizeof
(uint32_t)));

/* rest is data */
fwone->fws_data = data + sizeof(uint32_t);
fwone->fws_len = dlen - sizeof(uint32_t);

fws->fw_count++;
fws->fw_totlen += fwone->fws_len;

return 0;
979}

981#define IWX_DEFAULT_SCAN_CHANNELS40	40
982/* Newer firmware might support more channels. Raise this value if needed. */
983#define IWX_MAX_SCAN_CHANNELS67		67 /* as of iwx-cc-a0-62 firmware */

985struct iwx_tlv_calib_data {
uint32_t ucode_type;
struct iwx_tlv_calib_ctrl calib;
988} __packed__attribute__((__packed__));

990int
991iwx_set_default_calib(struct iwx_softc *sc, const void *data)
992{
const struct iwx_tlv_calib_data *def_calib = data;
uint32_t ucode_type = le32toh(def_calib->ucode_type)((__uint32_t)(def_calib->ucode_type));

if (ucode_type >= IWX_UCODE_TYPE_MAX)
return EINVAL22;

sc->sc_default_calib[ucode_type].flow_trigger =
   def_calib->calib.flow_trigger;
sc->sc_default_calib[ucode_type].event_trigger =
   def_calib->calib.event_trigger;

return 0;
1005}

1007void
1008iwx_fw_info_free(struct iwx_fw_info *fw)
1009{
free(fw->fw_rawdata, M_DEVBUF2, fw->fw_rawsize);
fw->fw_rawdata = NULL((void *)0);
fw->fw_rawsize = 0;
/* don't touch fw->fw_status */
memset(fw->fw_sects, 0, sizeof(fw->fw_sects))__builtin_memset((fw->fw_sects), (0), (sizeof(fw->fw_sects
)));
1015}

1017#define IWX_FW_ADDR_CACHE_CONTROL0xC0000000 0xC0000000

1019int
1020iwx_read_firmware(struct iwx_softc *sc)
1021{
struct iwx_fw_info *fw = &sc->sc_fw;
struct iwx_tlv_ucode_header *uhdr;
struct iwx_ucode_tlv tlv;
uint32_t tlv_type;
uint8_t *data;
int err;
size_t len;

if (fw->fw_status == IWX_FW_STATUS_DONE2)
return 0;

while (fw->fw_status == IWX_FW_STATUS_INPROGRESS1)
tsleep_nsec(&sc->sc_fw, 0, "iwxfwp", INFSLP0xffffffffffffffffULL);
fw->fw_status = IWX_FW_STATUS_INPROGRESS1;

if (fw->fw_rawdata != NULL((void *)0))
iwx_fw_info_free(fw);

err = loadfirmware(sc->sc_fwname,
   (u_char **)&fw->fw_rawdata, &fw->fw_rawsize);
if (err) {
printf("%s: could not read firmware %s (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), sc->sc_fwname, err);
goto out;
}

sc->sc_capaflags = 0;
sc->sc_capa_n_scan_channels = IWX_DEFAULT_SCAN_CHANNELS40;
memset(sc->sc_enabled_capa, 0, sizeof(sc->sc_enabled_capa))__builtin_memset((sc->sc_enabled_capa), (0), (sizeof(sc->
sc_enabled_capa)));
memset(sc->sc_ucode_api, 0, sizeof(sc->sc_ucode_api))__builtin_memset((sc->sc_ucode_api), (0), (sizeof(sc->sc_ucode_api
)));
sc->n_cmd_versions = 0;

uhdr = (void *)fw->fw_rawdata;
if (*(uint32_t *)fw->fw_rawdata != 0
   || le32toh(uhdr->magic)((__uint32_t)(uhdr->magic)) != IWX_TLV_UCODE_MAGIC0x0a4c5749) {
printf("%s: invalid firmware %s\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), sc->sc_fwname);
err = EINVAL22;
goto out;
}

iwx_fw_version_str(sc->sc_fwver, sizeof(sc->sc_fwver),
   IWX_UCODE_MAJOR(le32toh(uhdr->ver))(((((__uint32_t)(uhdr->ver))) & 0xFF000000) >> 24
),
   IWX_UCODE_MINOR(le32toh(uhdr->ver))(((((__uint32_t)(uhdr->ver))) & 0x00FF0000) >> 16
),
   IWX_UCODE_API(le32toh(uhdr->ver))(((((__uint32_t)(uhdr->ver))) & 0x0000FF00) >> 8
));

data = uhdr->data;
len = fw->fw_rawsize - sizeof(*uhdr);

while (len >= sizeof(tlv)) {
size_t tlv_len;
void *tlv_data;

memcpy(&tlv, data, sizeof(tlv))__builtin_memcpy((&tlv), (data), (sizeof(tlv)));
tlv_len = le32toh(tlv.length)((__uint32_t)(tlv.length));
tlv_type = le32toh(tlv.type)((__uint32_t)(tlv.type));

len -= sizeof(tlv);
data += sizeof(tlv);
tlv_data = data;

if (len < tlv_len) {
	printf("%s: firmware too short: %zu bytes\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), len);
	err = EINVAL22;
	goto parse_out;
}

switch (tlv_type) {
case IWX_UCODE_TLV_PROBE_MAX_LEN6:
	if (tlv_len < sizeof(uint32_t)) {
		err = EINVAL22;
		goto parse_out;
	}
	sc->sc_capa_max_probe_len
	    = le32toh(*(uint32_t *)tlv_data)((__uint32_t)(*(uint32_t *)tlv_data));
	if (sc->sc_capa_max_probe_len >
	    IWX_SCAN_OFFLOAD_PROBE_REQ_SIZE512) {
		err = EINVAL22;
		goto parse_out;
	}
	break;
case IWX_UCODE_TLV_PAN7:
	if (tlv_len) {
		err = EINVAL22;
		goto parse_out;
	}
	sc->sc_capaflags |= IWX_UCODE_TLV_FLAGS_PAN(1 << 0);
	break;
case IWX_UCODE_TLV_FLAGS18:
	if (tlv_len < sizeof(uint32_t)) {
		err = EINVAL22;
		goto parse_out;
	}
	/*
	 * Apparently there can be many flags, but Linux driver
	 * parses only the first one, and so do we.
	 *
	 * XXX: why does this override IWX_UCODE_TLV_PAN?
	 * Intentional or a bug?  Observations from
	 * current firmware file:
	 *  1) TLV_PAN is parsed first
	 *  2) TLV_FLAGS contains TLV_FLAGS_PAN
	 * ==> this resets TLV_PAN to itself... hnnnk
	 */
	sc->sc_capaflags = le32toh(*(uint32_t *)tlv_data)((__uint32_t)(*(uint32_t *)tlv_data));
	break;
case IWX_UCODE_TLV_CSCHEME28:
	err = iwx_store_cscheme(sc, tlv_data, tlv_len);
	if (err)
		goto parse_out;
	break;
case IWX_UCODE_TLV_NUM_OF_CPU27: {
	uint32_t num_cpu;
	if (tlv_len != sizeof(uint32_t)) {
		err = EINVAL22;
		goto parse_out;
	}
	num_cpu = le32toh(*(uint32_t *)tlv_data)((__uint32_t)(*(uint32_t *)tlv_data));
	if (num_cpu < 1 || num_cpu > 2) {
		err = EINVAL22;
		goto parse_out;
	}
	break;
}
case IWX_UCODE_TLV_SEC_RT19:
	err = iwx_firmware_store_section(sc,
	    IWX_UCODE_TYPE_REGULAR, tlv_data, tlv_len);
	if (err)
		goto parse_out;
	break;
case IWX_UCODE_TLV_SEC_INIT20:
	err = iwx_firmware_store_section(sc,
	    IWX_UCODE_TYPE_INIT, tlv_data, tlv_len);
	if (err)
		goto parse_out;
	break;
case IWX_UCODE_TLV_SEC_WOWLAN21:
	err = iwx_firmware_store_section(sc,
	    IWX_UCODE_TYPE_WOW, tlv_data, tlv_len);
	if (err)
		goto parse_out;
	break;
case IWX_UCODE_TLV_DEF_CALIB22:
	if (tlv_len != sizeof(struct iwx_tlv_calib_data)) {
		err = EINVAL22;
		goto parse_out;
	}
	err = iwx_set_default_calib(sc, tlv_data);
	if (err)
		goto parse_out;
	break;
case IWX_UCODE_TLV_PHY_SKU23:
	if (tlv_len != sizeof(uint32_t)) {
		err = EINVAL22;
		goto parse_out;
	}
	sc->sc_fw_phy_config = le32toh(*(uint32_t *)tlv_data)((__uint32_t)(*(uint32_t *)tlv_data));
	break;

case IWX_UCODE_TLV_API_CHANGES_SET29: {
	struct iwx_ucode_api *api;
	int idx, i;
	if (tlv_len != sizeof(*api)) {
		err = EINVAL22;
		goto parse_out;
	}
	api = (struct iwx_ucode_api *)tlv_data;
	idx = le32toh(api->api_index)((__uint32_t)(api->api_index));
	if (idx >= howmany(IWX_NUM_UCODE_TLV_API, 32)(((128) + ((32) - 1)) / (32))) {
		err = EINVAL22;
		goto parse_out;
	}
	for (i = 0; i < 32; i++) {
		if ((le32toh(api->api_flags)((__uint32_t)(api->api_flags)) & (1 << i)) == 0)
			continue;
		setbit(sc->sc_ucode_api, i + (32 * idx))((sc->sc_ucode_api)[(i + (32 * idx))>>3] |= 1<<
((i + (32 * idx))&(8 -1)));
	}
	break;
}

case IWX_UCODE_TLV_ENABLED_CAPABILITIES30: {
	struct iwx_ucode_capa *capa;
	int idx, i;
	if (tlv_len != sizeof(*capa)) {
		err = EINVAL22;
		goto parse_out;
	}
	capa = (struct iwx_ucode_capa *)tlv_data;
	idx = le32toh(capa->api_index)((__uint32_t)(capa->api_index));
	if (idx >= howmany(IWX_NUM_UCODE_TLV_CAPA, 32)(((128) + ((32) - 1)) / (32))) {
		goto parse_out;
	}
	for (i = 0; i < 32; i++) {
		if ((le32toh(capa->api_capa)((__uint32_t)(capa->api_capa)) & (1 << i)) == 0)
			continue;
		setbit(sc->sc_enabled_capa, i + (32 * idx))((sc->sc_enabled_capa)[(i + (32 * idx))>>3] |= 1<<
((i + (32 * idx))&(8 -1)));
	}
	break;
}

case IWX_UCODE_TLV_SDIO_ADMA_ADDR35:
case IWX_UCODE_TLV_FW_GSCAN_CAPA50:
	/* ignore, not used by current driver */
	break;

case IWX_UCODE_TLV_SEC_RT_USNIFFER34:
	err = iwx_firmware_store_section(sc,
	    IWX_UCODE_TYPE_REGULAR_USNIFFER, tlv_data,
	    tlv_len);
	if (err)
		goto parse_out;
	break;

case IWX_UCODE_TLV_PAGING32:
	if (tlv_len != sizeof(uint32_t)) {
		err = EINVAL22;
		goto parse_out;
	}
	break;

case IWX_UCODE_TLV_N_SCAN_CHANNELS31:
	if (tlv_len != sizeof(uint32_t)) {
		err = EINVAL22;
		goto parse_out;
	}
	sc->sc_capa_n_scan_channels =
	  le32toh(*(uint32_t *)tlv_data)((__uint32_t)(*(uint32_t *)tlv_data));
	if (sc->sc_capa_n_scan_channels > IWX_MAX_SCAN_CHANNELS67) {
		err = ERANGE34;
		goto parse_out;
	}
	break;

case IWX_UCODE_TLV_FW_VERSION36:
	if (tlv_len != sizeof(uint32_t) * 3) {
		err = EINVAL22;
		goto parse_out;
	}

	iwx_fw_version_str(sc->sc_fwver, sizeof(sc->sc_fwver),
	    le32toh(((uint32_t *)tlv_data)[0])((__uint32_t)(((uint32_t *)tlv_data)[0])),
	    le32toh(((uint32_t *)tlv_data)[1])((__uint32_t)(((uint32_t *)tlv_data)[1])),
	    le32toh(((uint32_t *)tlv_data)[2])((__uint32_t)(((uint32_t *)tlv_data)[2])));
	break;

case IWX_UCODE_TLV_FW_DBG_DEST38: {
	struct iwx_fw_dbg_dest_tlv_v1 *dest_v1 = NULL((void *)0);

	fw->dbg_dest_ver = (uint8_t *)tlv_data;
	if (*fw->dbg_dest_ver != 0) {
		err = EINVAL22;
		goto parse_out;
	}

	if (fw->dbg_dest_tlv_init)
		break;
	fw->dbg_dest_tlv_init = true1;

	dest_v1 = (void *)tlv_data;
	fw->dbg_dest_tlv_v1 = dest_v1;
	fw->n_dest_reg = tlv_len -
	    offsetof(struct iwx_fw_dbg_dest_tlv_v1, reg_ops)__builtin_offsetof(struct iwx_fw_dbg_dest_tlv_v1, reg_ops);
	fw->n_dest_reg /= sizeof(dest_v1->reg_ops[0]);
	DPRINTF(("%s: found debug dest; n_dest_reg=%d\n", __func__, fw->n_dest_reg))do { ; } while (0);
	break;
}

case IWX_UCODE_TLV_FW_DBG_CONF39: {
	struct iwx_fw_dbg_conf_tlv *conf = (void *)tlv_data;

	if (!fw->dbg_dest_tlv_init ||
	    conf->id >= nitems(fw->dbg_conf_tlv)(sizeof((fw->dbg_conf_tlv)) / sizeof((fw->dbg_conf_tlv)
[0])) ||
	    fw->dbg_conf_tlv[conf->id] != NULL((void *)0))
		break;

	DPRINTF(("Found debug configuration: %d\n", conf->id))do { ; } while (0);
	fw->dbg_conf_tlv[conf->id] = conf;
	fw->dbg_conf_tlv_len[conf->id] = tlv_len;
	break;
}

case IWX_UCODE_TLV_UMAC_DEBUG_ADDRS54: {
	struct iwx_umac_debug_addrs *dbg_ptrs =
		(void *)tlv_data;

	if (tlv_len != sizeof(*dbg_ptrs)) {
		err = EINVAL22;
		goto parse_out;
	}
	if (sc->sc_device_family < IWX_DEVICE_FAMILY_220001)
		break;
	sc->sc_uc.uc_umac_error_event_table =
		le32toh(dbg_ptrs->error_info_addr)((__uint32_t)(dbg_ptrs->error_info_addr)) &
		~IWX_FW_ADDR_CACHE_CONTROL0xC0000000;
	sc->sc_uc.error_event_table_tlv_status |=
		IWX_ERROR_EVENT_TABLE_UMAC(1 << 2);
	break;
}

case IWX_UCODE_TLV_LMAC_DEBUG_ADDRS55: {
	struct iwx_lmac_debug_addrs *dbg_ptrs =
		(void *)tlv_data;

	if (tlv_len != sizeof(*dbg_ptrs)) {
		err = EINVAL22;
		goto parse_out;
	}
	if (sc->sc_device_family < IWX_DEVICE_FAMILY_220001)
		break;
	sc->sc_uc.uc_lmac_error_event_table[0] =
		le32toh(dbg_ptrs->error_event_table_ptr)((__uint32_t)(dbg_ptrs->error_event_table_ptr)) &
		~IWX_FW_ADDR_CACHE_CONTROL0xC0000000;
	sc->sc_uc.error_event_table_tlv_status |=
		IWX_ERROR_EVENT_TABLE_LMAC1(1 << 0);
	break;
}

case IWX_UCODE_TLV_FW_MEM_SEG51:
	break;

case IWX_UCODE_TLV_CMD_VERSIONS48:
	if (tlv_len % sizeof(struct iwx_fw_cmd_version)) {
		tlv_len /= sizeof(struct iwx_fw_cmd_version);
		tlv_len *= sizeof(struct iwx_fw_cmd_version);
	}
	if (sc->n_cmd_versions != 0) {
		err = EINVAL22;
		goto parse_out;
	}
	if (tlv_len > sizeof(sc->cmd_versions)) {
		err = EINVAL22;
		goto parse_out;
	}
	memcpy(&sc->cmd_versions[0], tlv_data, tlv_len)__builtin_memcpy((&sc->cmd_versions[0]), (tlv_data), (
tlv_len));
	sc->n_cmd_versions = tlv_len / sizeof(struct iwx_fw_cmd_version);
	break;

case IWX_UCODE_TLV_FW_RECOVERY_INFO57:
	break;

case IWX_UCODE_TLV_FW_FSEQ_VERSION60:
case IWX_UCODE_TLV_PHY_INTEGRATION_VERSION61:
case IWX_UCODE_TLV_FW_NUM_STATIONS(0x100 + 0):
	break;

/* undocumented TLVs found in iwx-cc-a0-46 image */
case 58:
case 0x1000003:
case 0x1000004:
	break;

/* undocumented TLVs found in iwx-cc-a0-48 image */
case 0x1000000:
case 0x1000002:
	break;

case IWX_UCODE_TLV_TYPE_DEBUG_INFO(0x1000005 + 0):
case IWX_UCODE_TLV_TYPE_BUFFER_ALLOCATION(0x1000005 + 1):
case IWX_UCODE_TLV_TYPE_HCMD(0x1000005 + 2):
case IWX_UCODE_TLV_TYPE_REGIONS(0x1000005 + 3):
case IWX_UCODE_TLV_TYPE_TRIGGERS(0x1000005 + 4):
case IWX_UCODE_TLV_TYPE_CONF_SET(0x1000005 + 5):
	break;

/* undocumented TLV found in iwx-cc-a0-67 image */
case 0x100000b:
	break;

default:
	err = EINVAL22;
	goto parse_out;
}

len -= roundup(tlv_len, 4)((((tlv_len)+((4)-1))/(4))*(4));
data += roundup(tlv_len, 4)((((tlv_len)+((4)-1))/(4))*(4));
}

KASSERT(err == 0)((err == 0) ? (void)0 : __assert("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c"
, 1400, "err == 0"));

parse_out:
if (err) {
printf("%s: firmware parse error %d, "
    "section type %d\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), err, tlv_type);
}

out:
if (err) {
fw->fw_status = IWX_FW_STATUS_NONE0;
if (fw->fw_rawdata != NULL((void *)0))
	iwx_fw_info_free(fw);
} else
fw->fw_status = IWX_FW_STATUS_DONE2;
wakeup(&sc->sc_fw);

return err;
1418}

1420uint32_t
1421iwx_read_prph_unlocked(struct iwx_softc *sc, uint32_t addr)
1422{
IWX_WRITE(sc,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x400)+0x048
))), ((((addr & 0x000fffff) | (3 << 24))))))
   IWX_HBUS_TARG_PRPH_RADDR, ((addr & 0x000fffff) | (3 << 24)))(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x400)+0x048
))), ((((addr & 0x000fffff) | (3 << 24))))));
IWX_BARRIER_READ_WRITE(sc)bus_space_barrier((sc)->sc_st, (sc)->sc_sh, 0, (sc)->
sc_sz, 0x01 | 0x02);
return IWX_READ(sc, IWX_HBUS_TARG_PRPH_RDAT)(((sc)->sc_st)->read_4(((sc)->sc_sh), ((((0x400)+0x050
)))));
1427}

1429uint32_t
1430iwx_read_prph(struct iwx_softc *sc, uint32_t addr)
1431{
iwx_nic_assert_locked(sc);
return iwx_read_prph_unlocked(sc, addr);
1434}

1436void
1437iwx_write_prph_unlocked(struct iwx_softc *sc, uint32_t addr, uint32_t val)
1438{
IWX_WRITE(sc,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x400)+0x044
))), ((((addr & 0x000fffff) | (3 << 24))))))
   IWX_HBUS_TARG_PRPH_WADDR, ((addr & 0x000fffff) | (3 << 24)))(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x400)+0x044
))), ((((addr & 0x000fffff) | (3 << 24))))));
IWX_BARRIER_WRITE(sc)bus_space_barrier((sc)->sc_st, (sc)->sc_sh, 0, (sc)->
sc_sz, 0x02);
IWX_WRITE(sc, IWX_HBUS_TARG_PRPH_WDAT, val)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x400)+0x04c
))), ((val))));
1443}

1445void
1446iwx_write_prph(struct iwx_softc *sc, uint32_t addr, uint32_t val)
1447{
iwx_nic_assert_locked(sc);
iwx_write_prph_unlocked(sc, addr, val);
1450}

1452void
1453iwx_write_prph64(struct iwx_softc *sc, uint64_t addr, uint64_t val)
1454{
iwx_write_prph(sc, (uint32_t)addr, val & 0xffffffff);
iwx_write_prph(sc, (uint32_t)addr + 4, val >> 32);
1457}

1459int
1460iwx_read_mem(struct iwx_softc *sc, uint32_t addr, void *buf, int dwords)
1461{
int offs, err = 0;
uint32_t *vals = buf;

if (iwx_nic_lock(sc)) {
IWX_WRITE(sc, IWX_HBUS_TARG_MEM_RADDR, addr)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x400)+0x00c
))), ((addr))));
for (offs = 0; offs < dwords; offs++)
	vals[offs] = le32toh(IWX_READ(sc, IWX_HBUS_TARG_MEM_RDAT))((__uint32_t)((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x400)+0x01c)))))));
iwx_nic_unlock(sc);
} else {
err = EBUSY16;
}
return err;
1474}

1476int
1477iwx_write_mem(struct iwx_softc *sc, uint32_t addr, const void *buf, int dwords)
1478{
int offs;	
const uint32_t *vals = buf;

if (iwx_nic_lock(sc)) {
IWX_WRITE(sc, IWX_HBUS_TARG_MEM_WADDR, addr)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x400)+0x010
))), ((addr))));
/* WADDR auto-increments */
for (offs = 0; offs < dwords; offs++) {
	uint32_t val = vals ? vals[offs] : 0;
	IWX_WRITE(sc, IWX_HBUS_TARG_MEM_WDAT, val)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x400)+0x018
))), ((val))));
}
iwx_nic_unlock(sc);
} else {
return EBUSY16;
}
return 0;
1494}

1496int
1497iwx_write_mem32(struct iwx_softc *sc, uint32_t addr, uint32_t val)
1498{
return iwx_write_mem(sc, addr, &val, 1);
1500}

1502int
1503iwx_poll_bit(struct iwx_softc *sc, int reg, uint32_t bits, uint32_t mask,
  int timo)
1505{
for (;;) {
if ((IWX_READ(sc, reg)(((sc)->sc_st)->read_4(((sc)->sc_sh), ((reg)))) & mask) == (bits & mask)) {
	return 1;
}
if (timo < 10) {
	return 0;
}
timo -= 10;
DELAY(10)(*delay_func)(10);
}
1516}

1518int
1519iwx_nic_lock(struct iwx_softc *sc)
1520{
if (sc->sc_nic_locks > 0) {
iwx_nic_assert_locked(sc);
sc->sc_nic_locks++;
return 1; /* already locked */
}

IWX_SETBITS(sc, IWX_CSR_GP_CNTRL,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 | ((0x00000008))))))
   IWX_CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 | ((0x00000008))))));

DELAY(2)(*delay_func)(2);

if (iwx_poll_bit(sc, IWX_CSR_GP_CNTRL(0x024),
   IWX_CSR_GP_CNTRL_REG_VAL_MAC_ACCESS_EN(0x00000001),
   IWX_CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY(0x00000001)
    | IWX_CSR_GP_CNTRL_REG_FLAG_GOING_TO_SLEEP(0x00000010), 150000)) {
sc->sc_nic_locks++;
return 1;
}

printf("%s: acquiring device failed\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return 0;
1542}

1544void
1545iwx_nic_assert_locked(struct iwx_softc *sc)
1546{
if (sc->sc_nic_locks <= 0)
panic("%s: nic locks counter %d", DEVNAME(sc)((sc)->sc_dev.dv_xname), sc->sc_nic_locks);
1549}

1551void
1552iwx_nic_unlock(struct iwx_softc *sc)
1553{
if (sc->sc_nic_locks > 0) {
if (--sc->sc_nic_locks == 0)
	IWX_CLRBITS(sc, IWX_CSR_GP_CNTRL,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 & ~((0x00000008))))))
	    IWX_CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 & ~((0x00000008))))));
} else
printf("%s: NIC already unlocked\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
1560}

1562int
1563iwx_set_bits_mask_prph(struct iwx_softc *sc, uint32_t reg, uint32_t bits,
  uint32_t mask)
1565{
uint32_t val;

if (iwx_nic_lock(sc)) {
val = iwx_read_prph(sc, reg) & mask;
val |= bits;
iwx_write_prph(sc, reg, val);
iwx_nic_unlock(sc);
return 0;
}
return EBUSY16;
1576}

1578int
1579iwx_set_bits_prph(struct iwx_softc *sc, uint32_t reg, uint32_t bits)
1580{
return iwx_set_bits_mask_prph(sc, reg, bits, ~0);
1582}

1584int
1585iwx_clear_bits_prph(struct iwx_softc *sc, uint32_t reg, uint32_t bits)
1586{
return iwx_set_bits_mask_prph(sc, reg, 0, ~bits);
1588}

1590int
1591iwx_dma_contig_alloc(bus_dma_tag_t tag, struct iwx_dma_info *dma,
  bus_size_t size, bus_size_t alignment)
1593{
int nsegs, err;
caddr_t va;

dma->tag = tag;
dma->size = size;

err = bus_dmamap_create(tag, size, 1, size, 0, BUS_DMA_NOWAIT,(*(tag)->_dmamap_create)((tag), (size), (1), (size), (0), (
0x0001), (&dma->map))
   &dma->map)(*(tag)->_dmamap_create)((tag), (size), (1), (size), (0), (
0x0001), (&dma->map));
if (err)
goto fail;

err = bus_dmamem_alloc(tag, size, alignment, 0, &dma->seg, 1, &nsegs,(*(tag)->_dmamem_alloc)((tag), (size), (alignment), (0), (
&dma->seg), (1), (&nsegs), (0x0001))
   BUS_DMA_NOWAIT)(*(tag)->_dmamem_alloc)((tag), (size), (alignment), (0), (
&dma->seg), (1), (&nsegs), (0x0001));
if (err)
goto fail;

err = bus_dmamem_map(tag, &dma->seg, 1, size, &va,(*(tag)->_dmamem_map)((tag), (&dma->seg), (1), (size
), (&va), (0x0001))
   BUS_DMA_NOWAIT)(*(tag)->_dmamem_map)((tag), (&dma->seg), (1), (size
), (&va), (0x0001));
if (err)
goto fail;
dma->vaddr = va;

err = bus_dmamap_load(tag, dma->map, dma->vaddr, size, NULL,(*(tag)->_dmamap_load)((tag), (dma->map), (dma->vaddr
), (size), (((void *)0)), (0x0001))
   BUS_DMA_NOWAIT)(*(tag)->_dmamap_load)((tag), (dma->map), (dma->vaddr
), (size), (((void *)0)), (0x0001));
if (err)
goto fail;

memset(dma->vaddr, 0, size)__builtin_memset((dma->vaddr), (0), (size));
bus_dmamap_sync(tag, dma->map, 0, size, BUS_DMASYNC_PREWRITE)(*(tag)->_dmamap_sync)((tag), (dma->map), (0), (size), (
0x04));
dma->paddr = dma->map->dm_segs[0].ds_addr;

return 0;

1627fail:	iwx_dma_contig_free(dma);
return err;
1629}

1631void
1632iwx_dma_contig_free(struct iwx_dma_info *dma)
1633{
if (dma->map != NULL((void *)0)) {
if (dma->vaddr != NULL((void *)0)) {
	bus_dmamap_sync(dma->tag, dma->map, 0, dma->size,(*(dma->tag)->_dmamap_sync)((dma->tag), (dma->map
), (0), (dma->size), (0x02 | 0x08))
	    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE)(*(dma->tag)->_dmamap_sync)((dma->tag), (dma->map
), (0), (dma->size), (0x02 | 0x08));
	bus_dmamap_unload(dma->tag, dma->map)(*(dma->tag)->_dmamap_unload)((dma->tag), (dma->map
));
	bus_dmamem_unmap(dma->tag, dma->vaddr, dma->size)(*(dma->tag)->_dmamem_unmap)((dma->tag), (dma->vaddr
), (dma->size));
	bus_dmamem_free(dma->tag, &dma->seg, 1)(*(dma->tag)->_dmamem_free)((dma->tag), (&dma->
seg), (1));
	dma->vaddr = NULL((void *)0);
}
bus_dmamap_destroy(dma->tag, dma->map)(*(dma->tag)->_dmamap_destroy)((dma->tag), (dma->
map));
dma->map = NULL((void *)0);
}
1646}

1648int
1649iwx_alloc_rx_ring(struct iwx_softc *sc, struct iwx_rx_ring *ring)
1650{
bus_size_t size;
int i, err;

ring->cur = 0;

/* Allocate RX descriptors (256-byte aligned). */
size = IWX_RX_MQ_RING_COUNT512 * sizeof(uint64_t);
err = iwx_dma_contig_alloc(sc->sc_dmat, &ring->free_desc_dma, size, 256);
if (err) {
printf("%s: could not allocate RX ring DMA memory\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
goto fail;
}
ring->desc = ring->free_desc_dma.vaddr;

/* Allocate RX status area (16-byte aligned). */
err = iwx_dma_contig_alloc(sc->sc_dmat, &ring->stat_dma,
   sizeof(*ring->stat), 16);
if (err) {
printf("%s: could not allocate RX status DMA memory\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
goto fail;
}
ring->stat = ring->stat_dma.vaddr;

size = IWX_RX_MQ_RING_COUNT512 * sizeof(uint32_t);
err = iwx_dma_contig_alloc(sc->sc_dmat, &ring->used_desc_dma,
   size, 256);
if (err) {
printf("%s: could not allocate RX ring DMA memory\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
goto fail;
}

for (i = 0; i < IWX_RX_MQ_RING_COUNT512; i++) {
struct iwx_rx_data *data = &ring->data[i];

memset(data, 0, sizeof(*data))__builtin_memset((data), (0), (sizeof(*data)));
err = bus_dmamap_create(sc->sc_dmat, IWX_RBUF_SIZE, 1,(*(sc->sc_dmat)->_dmamap_create)((sc->sc_dmat), (4096
), (1), (4096), (0), (0x0001 | 0x0002), (&data->map))
    IWX_RBUF_SIZE, 0, BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,(*(sc->sc_dmat)->_dmamap_create)((sc->sc_dmat), (4096
), (1), (4096), (0), (0x0001 | 0x0002), (&data->map))
    &data->map)(*(sc->sc_dmat)->_dmamap_create)((sc->sc_dmat), (4096
), (1), (4096), (0), (0x0001 | 0x0002), (&data->map));
if (err) {
	printf("%s: could not create RX buf DMA map\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname));
	goto fail;
}

err = iwx_rx_addbuf(sc, IWX_RBUF_SIZE4096, i);
if (err)
	goto fail;
}
return 0;

1704fail:	iwx_free_rx_ring(sc, ring);
return err;
1706}

1708void
1709iwx_disable_rx_dma(struct iwx_softc *sc)
1710{
int ntries;

if (iwx_nic_lock(sc)) {
iwx_write_prph(sc, IWX_RFH_RXF_DMA_CFG0xA09820, 0);
for (ntries = 0; ntries < 1000; ntries++) {
	if (iwx_read_prph(sc, IWX_RFH_GEN_STATUS0xA09808) &
	    IWX_RXF_DMA_IDLE(1U << 31))
		break;
	DELAY(10)(*delay_func)(10);
}
iwx_nic_unlock(sc);
}
1723}

1725void
1726iwx_reset_rx_ring(struct iwx_softc *sc, struct iwx_rx_ring *ring)
1727{
ring->cur = 0;
bus_dmamap_sync(sc->sc_dmat, ring->stat_dma.map, 0,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
stat_dma.map), (0), (ring->stat_dma.size), (0x04))
   ring->stat_dma.size, BUS_DMASYNC_PREWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
stat_dma.map), (0), (ring->stat_dma.size), (0x04));
memset(ring->stat, 0, sizeof(*ring->stat))__builtin_memset((ring->stat), (0), (sizeof(*ring->stat
)));
bus_dmamap_sync(sc->sc_dmat, ring->stat_dma.map, 0,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
stat_dma.map), (0), (ring->stat_dma.size), (0x08))
   ring->stat_dma.size, BUS_DMASYNC_POSTWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
stat_dma.map), (0), (ring->stat_dma.size), (0x08));

1735}

1737void
1738iwx_free_rx_ring(struct iwx_softc *sc, struct iwx_rx_ring *ring)
1739{
int i;

iwx_dma_contig_free(&ring->free_desc_dma);
iwx_dma_contig_free(&ring->stat_dma);
iwx_dma_contig_free(&ring->used_desc_dma);

for (i = 0; i < IWX_RX_MQ_RING_COUNT512; i++) {
struct iwx_rx_data *data = &ring->data[i];

if (data->m != NULL((void *)0)) {
	bus_dmamap_sync(sc->sc_dmat, data->map, 0,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (data->map->dm_mapsize), (0x02))
	    data->map->dm_mapsize, BUS_DMASYNC_POSTREAD)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (data->map->dm_mapsize), (0x02));
	bus_dmamap_unload(sc->sc_dmat, data->map)(*(sc->sc_dmat)->_dmamap_unload)((sc->sc_dmat), (data
->map));
	m_freem(data->m);
	data->m = NULL((void *)0);
}
if (data->map != NULL((void *)0))
	bus_dmamap_destroy(sc->sc_dmat, data->map)(*(sc->sc_dmat)->_dmamap_destroy)((sc->sc_dmat), (data
->map));
}
1759}

1761int
1762iwx_alloc_tx_ring(struct iwx_softc *sc, struct iwx_tx_ring *ring, int qid)
1763{
bus_addr_t paddr;
bus_size_t size;
int i, err;

ring->qid = qid;
ring->queued = 0;
ring->cur = 0;
ring->tail = 0;

/* Allocate TX descriptors (256-byte aligned). */
size = IWX_TX_RING_COUNT(256) * sizeof(struct iwx_tfh_tfd);
err = iwx_dma_contig_alloc(sc->sc_dmat, &ring->desc_dma, size, 256);
if (err) {
printf("%s: could not allocate TX ring DMA memory\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
goto fail;
}
ring->desc = ring->desc_dma.vaddr;

/*
* The hardware supports up to 512 Tx rings which is more
* than we currently need.
*
* In DQA mode we use 1 command queue + 1 default queue for
* management, control, and non-QoS data frames.
* The command is queue sc->txq[0], our default queue is sc->txq[1].
*
* Tx aggregation requires additional queues, one queue per TID for
* which aggregation is enabled. We map TID 0-7 to sc->txq[2:9].
* Firmware may assign its own internal IDs for these queues
* depending on which TID gets aggregation enabled first.
* The driver maintains a table mapping driver-side queue IDs
* to firmware-side queue IDs.
*/

err = iwx_dma_contig_alloc(sc->sc_dmat, &ring->bc_tbl,
   sizeof(struct iwx_agn_scd_bc_tbl), 0);
if (err) {
printf("%s: could not allocate byte count table DMA memory\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
goto fail;
}

size = IWX_TX_RING_COUNT(256) * sizeof(struct iwx_device_cmd);
err = iwx_dma_contig_alloc(sc->sc_dmat, &ring->cmd_dma, size,
   IWX_FIRST_TB_SIZE_ALIGN((20 + (64 - 1)) & ~(64 - 1)));
if (err) {
printf("%s: could not allocate cmd DMA memory\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
goto fail;
}
ring->cmd = ring->cmd_dma.vaddr;

paddr = ring->cmd_dma.paddr;
for (i = 0; i < IWX_TX_RING_COUNT(256); i++) {
struct iwx_tx_data *data = &ring->data[i];
size_t mapsize;

data->cmd_paddr = paddr;
paddr += sizeof(struct iwx_device_cmd);

/* FW commands may require more mapped space than packets. */
if (qid == IWX_DQA_CMD_QUEUE0)
	mapsize = (sizeof(struct iwx_cmd_header) +
	    IWX_MAX_CMD_PAYLOAD_SIZE(4096 - sizeof(struct iwx_cmd_header_wide)));
else
	mapsize = MCLBYTES(1 << 11);
err = bus_dmamap_create(sc->sc_dmat, mapsize,(*(sc->sc_dmat)->_dmamap_create)((sc->sc_dmat), (mapsize
), (25 - 2), (mapsize), (0), (0x0001), (&data->map))
    IWX_TFH_NUM_TBS - 2, mapsize, 0, BUS_DMA_NOWAIT,(*(sc->sc_dmat)->_dmamap_create)((sc->sc_dmat), (mapsize
), (25 - 2), (mapsize), (0), (0x0001), (&data->map))
    &data->map)(*(sc->sc_dmat)->_dmamap_create)((sc->sc_dmat), (mapsize
), (25 - 2), (mapsize), (0), (0x0001), (&data->map));
if (err) {
	printf("%s: could not create TX buf DMA map\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname));
	goto fail;
}
}
KASSERT(paddr == ring->cmd_dma.paddr + size)((paddr == ring->cmd_dma.paddr + size) ? (void)0 : __assert
("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c", 1839, "paddr == ring->cmd_dma.paddr + size"
));
return 0;

1842fail:	iwx_free_tx_ring(sc, ring);
return err;
1844}

1846void
1847iwx_reset_tx_ring(struct iwx_softc *sc, struct iwx_tx_ring *ring)
1848{
int i;

for (i = 0; i < IWX_TX_RING_COUNT(256); i++) {
struct iwx_tx_data *data = &ring->data[i];

if (data->m != NULL((void *)0)) {
	bus_dmamap_sync(sc->sc_dmat, data->map, 0,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (data->map->dm_mapsize), (0x08))
	    data->map->dm_mapsize, BUS_DMASYNC_POSTWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (data->map->dm_mapsize), (0x08));
	bus_dmamap_unload(sc->sc_dmat, data->map)(*(sc->sc_dmat)->_dmamap_unload)((sc->sc_dmat), (data
->map));
	m_freem(data->m);
	data->m = NULL((void *)0);
}
}

/* Clear byte count table. */
memset(ring->bc_tbl.vaddr, 0, ring->bc_tbl.size)__builtin_memset((ring->bc_tbl.vaddr), (0), (ring->bc_tbl
.size));

/* Clear TX descriptors. */
memset(ring->desc, 0, ring->desc_dma.size)__builtin_memset((ring->desc), (0), (ring->desc_dma.size
));
bus_dmamap_sync(sc->sc_dmat, ring->desc_dma.map, 0,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
desc_dma.map), (0), (ring->desc_dma.size), (0x04))
   ring->desc_dma.size, BUS_DMASYNC_PREWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
desc_dma.map), (0), (ring->desc_dma.size), (0x04));
sc->qfullmsk &= ~(1 << ring->qid);
sc->qenablemsk &= ~(1 << ring->qid);
for (i = 0; i < nitems(sc->aggqid)(sizeof((sc->aggqid)) / sizeof((sc->aggqid)[0])); i++) {
if (sc->aggqid[i] == ring->qid) {
	sc->aggqid[i] = 0;
	break;
}
}
ring->queued = 0;
ring->cur = 0;
ring->tail = 0;
ring->tid = 0;
1882}

1884void
1885iwx_free_tx_ring(struct iwx_softc *sc, struct iwx_tx_ring *ring)
1886{
int i;

iwx_dma_contig_free(&ring->desc_dma);
iwx_dma_contig_free(&ring->cmd_dma);
iwx_dma_contig_free(&ring->bc_tbl);

for (i = 0; i < IWX_TX_RING_COUNT(256); i++) {
struct iwx_tx_data *data = &ring->data[i];

if (data->m != NULL((void *)0)) {
	bus_dmamap_sync(sc->sc_dmat, data->map, 0,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (data->map->dm_mapsize), (0x08))
	    data->map->dm_mapsize, BUS_DMASYNC_POSTWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (data->map->dm_mapsize), (0x08));
	bus_dmamap_unload(sc->sc_dmat, data->map)(*(sc->sc_dmat)->_dmamap_unload)((sc->sc_dmat), (data
->map));
	m_freem(data->m);
	data->m = NULL((void *)0);
}
if (data->map != NULL((void *)0))
	bus_dmamap_destroy(sc->sc_dmat, data->map)(*(sc->sc_dmat)->_dmamap_destroy)((sc->sc_dmat), (data
->map));
}
1906}

1908void
1909iwx_enable_rfkill_int(struct iwx_softc *sc)
1910{
if (!sc->sc_msix) {
sc->sc_intmask = IWX_CSR_INT_BIT_RF_KILL(1 << 7);
IWX_WRITE(sc, IWX_CSR_INT_MASK, sc->sc_intmask)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x00c))), (
(sc->sc_intmask))));
} else {
IWX_WRITE(sc, IWX_CSR_MSIX_FH_INT_MASK_AD,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), ((sc->sc_fh_init_mask))))
    sc->sc_fh_init_mask)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), ((sc->sc_fh_init_mask))));
IWX_WRITE(sc, IWX_CSR_MSIX_HW_INT_MASK_AD,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), ((~IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL))))
    ~IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), ((~IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL))));
sc->sc_hw_mask = IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL;
}

IWX_SETBITS(sc, IWX_CSR_GP_CNTRL,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 | ((0x04000000))))))
   IWX_CSR_GP_CNTRL_REG_FLAG_RFKILL_WAKE_L1A_EN)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 | ((0x04000000))))));
1924}

1926int
1927iwx_check_rfkill(struct iwx_softc *sc)
1928{
uint32_t v;
int rv;

/*
* "documentation" is not really helpful here:
*  27:	HW_RF_KILL_SW
*	Indicates state of (platform's) hardware RF-Kill switch
*
* But apparently when it's off, it's on ...
*/
v = IWX_READ(sc, IWX_CSR_GP_CNTRL)(((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))));
rv = (v & IWX_CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW(0x08000000)) == 0;
if (rv) {
sc->sc_flags |= IWX_FLAG_RFKILL0x02;
} else {
sc->sc_flags &= ~IWX_FLAG_RFKILL0x02;
}

return rv;
1948}

1950void
1951iwx_enable_interrupts(struct iwx_softc *sc)
1952{
if (!sc->sc_msix) {
sc->sc_intmask = IWX_CSR_INI_SET_MASK((1U << 31) | (1 << 29) | (1 << 27) | (1 <<
 25) | (1 << 7) | (1 << 3) | (1 << 1) | (1 <<
 0) | (1 << 28));
IWX_WRITE(sc, IWX_CSR_INT_MASK, sc->sc_intmask)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x00c))), (
(sc->sc_intmask))));
} else {
/*
 * fh/hw_mask keeps all the unmasked causes.
 * Unlike msi, in msix cause is enabled when it is unset.
 */
sc->sc_hw_mask = sc->sc_hw_init_mask;
sc->sc_fh_mask = sc->sc_fh_init_mask;
IWX_WRITE(sc, IWX_CSR_MSIX_FH_INT_MASK_AD,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), ((~sc->sc_fh_mask))))
    ~sc->sc_fh_mask)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), ((~sc->sc_fh_mask))));
IWX_WRITE(sc, IWX_CSR_MSIX_HW_INT_MASK_AD,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), ((~sc->sc_hw_mask))))
    ~sc->sc_hw_mask)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), ((~sc->sc_hw_mask))));
}
1968}

1970void
1971iwx_enable_fwload_interrupt(struct iwx_softc *sc)
1972{
if (!sc->sc_msix) {
sc->sc_intmask = IWX_CSR_INT_BIT_ALIVE(1 << 0) | IWX_CSR_INT_BIT_FH_RX(1U << 31);
IWX_WRITE(sc, IWX_CSR_INT_MASK, sc->sc_intmask)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x00c))), (
(sc->sc_intmask))));
} else {
IWX_WRITE(sc, IWX_CSR_MSIX_HW_INT_MASK_AD,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), ((~IWX_MSIX_HW_INT_CAUSES_REG_ALIVE))))
    ~IWX_MSIX_HW_INT_CAUSES_REG_ALIVE)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), ((~IWX_MSIX_HW_INT_CAUSES_REG_ALIVE))));
sc->sc_hw_mask = IWX_MSIX_HW_INT_CAUSES_REG_ALIVE;
/*
 * Leave all the FH causes enabled to get the ALIVE
 * notification.
 */
IWX_WRITE(sc, IWX_CSR_MSIX_FH_INT_MASK_AD,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), ((~sc->sc_fh_init_mask))))
    ~sc->sc_fh_init_mask)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), ((~sc->sc_fh_init_mask))));
sc->sc_fh_mask = sc->sc_fh_init_mask;
}
1988}

1990void
1991iwx_restore_interrupts(struct iwx_softc *sc)
1992{
IWX_WRITE(sc, IWX_CSR_INT_MASK, sc->sc_intmask)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x00c))), (
(sc->sc_intmask))));
1994}

1996void
1997iwx_disable_interrupts(struct iwx_softc *sc)
1998{
if (!sc->sc_msix) {
IWX_WRITE(sc, IWX_CSR_INT_MASK, 0)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x00c))), (
(0))));

/* acknowledge all interrupts */
IWX_WRITE(sc, IWX_CSR_INT, ~0)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x008))), (
(~0))));
IWX_WRITE(sc, IWX_CSR_FH_INT_STATUS, ~0)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x010))), (
(~0))));
} else {
IWX_WRITE(sc, IWX_CSR_MSIX_FH_INT_MASK_AD,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), ((sc->sc_fh_init_mask))))
    sc->sc_fh_init_mask)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), ((sc->sc_fh_init_mask))));
IWX_WRITE(sc, IWX_CSR_MSIX_HW_INT_MASK_AD,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), ((sc->sc_hw_init_mask))))
    sc->sc_hw_init_mask)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), ((sc->sc_hw_init_mask))));
}
2011}

2013void
2014iwx_ict_reset(struct iwx_softc *sc)
2015{
iwx_disable_interrupts(sc);

memset(sc->ict_dma.vaddr, 0, IWX_ICT_SIZE)__builtin_memset((sc->ict_dma.vaddr), (0), (4096));
sc->ict_cur = 0;

/* Set physical address of ICT (4KB aligned). */
IWX_WRITE(sc, IWX_CSR_DRAM_INT_TBL_REG,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x0A0))), (
((1U << 31) | (1 << 27) | (1 << 28) | sc->
ict_dma.paddr >> 12))))
   IWX_CSR_DRAM_INT_TBL_ENABLE(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x0A0))), (
((1U << 31) | (1 << 27) | (1 << 28) | sc->
ict_dma.paddr >> 12))))
   | IWX_CSR_DRAM_INIT_TBL_WRAP_CHECK(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x0A0))), (
((1U << 31) | (1 << 27) | (1 << 28) | sc->
ict_dma.paddr >> 12))))
   | IWX_CSR_DRAM_INIT_TBL_WRITE_POINTER(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x0A0))), (
((1U << 31) | (1 << 27) | (1 << 28) | sc->
ict_dma.paddr >> 12))))
   | sc->ict_dma.paddr >> IWX_ICT_PADDR_SHIFT)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x0A0))), (
((1U << 31) | (1 << 27) | (1 << 28) | sc->
ict_dma.paddr >> 12))));

/* Switch to ICT interrupt mode in driver. */
sc->sc_flags |= IWX_FLAG_USE_ICT0x01;

IWX_WRITE(sc, IWX_CSR_INT, ~0)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x008))), (
(~0))));
iwx_enable_interrupts(sc);
2033}

2035#define IWX_HW_READY_TIMEOUT 50
2036int
2037iwx_set_hw_ready(struct iwx_softc *sc)
2038{
int ready;

IWX_SETBITS(sc, IWX_CSR_HW_IF_CONFIG_REG,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x000))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x000)))))
 | ((0x00400000))))))
   IWX_CSR_HW_IF_CONFIG_REG_BIT_NIC_READY)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x000))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x000)))))
 | ((0x00400000))))));

ready = iwx_poll_bit(sc, IWX_CSR_HW_IF_CONFIG_REG(0x000),
   IWX_CSR_HW_IF_CONFIG_REG_BIT_NIC_READY(0x00400000),
   IWX_CSR_HW_IF_CONFIG_REG_BIT_NIC_READY(0x00400000),
   IWX_HW_READY_TIMEOUT);
if (ready)
IWX_SETBITS(sc, IWX_CSR_MBOX_SET_REG,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x088))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x088)))))
 | (0x20)))))
    IWX_CSR_MBOX_SET_REG_OS_ALIVE)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x088))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x088)))))
 | (0x20)))));

return ready;
2053}
2054#undef IWX_HW_READY_TIMEOUT

2056int
2057iwx_prepare_card_hw(struct iwx_softc *sc)
2058{
int t = 0;
int ntries;

if (iwx_set_hw_ready(sc))
return 0;

IWX_SETBITS(sc, IWX_CSR_DBG_LINK_PWR_MGMT_REG,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x250))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x250)))))
 | ((0x80000000))))))
   IWX_CSR_RESET_LINK_PWR_MGMT_DISABLED)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x250))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x250)))))
 | ((0x80000000))))));
DELAY(1000)(*delay_func)(1000);

for (ntries = 0; ntries < 10; ntries++) {
/* If HW is not ready, prepare the conditions to check again */
IWX_SETBITS(sc, IWX_CSR_HW_IF_CONFIG_REG,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x000))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x000)))))
 | ((0x08000000))))))
    IWX_CSR_HW_IF_CONFIG_REG_PREPARE)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x000))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x000)))))
 | ((0x08000000))))));

do {
	if (iwx_set_hw_ready(sc))
		return 0;
	DELAY(200)(*delay_func)(200);
	t += 200;
} while (t < 150000);
DELAY(25000)(*delay_func)(25000);
}

return ETIMEDOUT60;
2084}

2086int
2087iwx_force_power_gating(struct iwx_softc *sc)
2088{
int err;

err = iwx_set_bits_prph(sc, IWX_HPM_HIPM_GEN_CFG0xa03458,
   IWX_HPM_HIPM_GEN_CFG_CR_FORCE_ACTIVE(1 << 10));
if (err)
return err;
DELAY(20)(*delay_func)(20);
err = iwx_set_bits_prph(sc, IWX_HPM_HIPM_GEN_CFG0xa03458,
   IWX_HPM_HIPM_GEN_CFG_CR_PG_EN(1 << 0) |
   IWX_HPM_HIPM_GEN_CFG_CR_SLP_EN(1 << 1));
if (err)
return err;
DELAY(20)(*delay_func)(20);
err = iwx_clear_bits_prph(sc, IWX_HPM_HIPM_GEN_CFG0xa03458,
   IWX_HPM_HIPM_GEN_CFG_CR_FORCE_ACTIVE(1 << 10));
return err;
2105}

2107void
2108iwx_apm_config(struct iwx_softc *sc)
2109{
pcireg_t lctl, cap;

/*
* L0S states have been found to be unstable with our devices
* and in newer hardware they are not officially supported at
* all, so we must always set the L0S_DISABLED bit.
*/
IWX_SETBITS(sc, IWX_CSR_GIO_REG, IWX_CSR_GIO_REG_VAL_L0S_DISABLED)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x03C))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x03C)))))
 | ((0x00000002))))));

lctl = pci_conf_read(sc->sc_pct, sc->sc_pcitag,
   sc->sc_cap_off + PCI_PCIE_LCSR0x10);
sc->sc_pm_support = !(lctl & PCI_PCIE_LCSR_ASPM_L0S0x00000001);
cap = pci_conf_read(sc->sc_pct, sc->sc_pcitag,
   sc->sc_cap_off + PCI_PCIE_DCSR20x28);
sc->sc_ltr_enabled = (cap & PCI_PCIE_DCSR2_LTREN0x00000400) ? 1 : 0;
DPRINTF(("%s: L1 %sabled - LTR %sabled\n",do { ; } while (0)
   DEVNAME(sc),do { ; } while (0)
   (lctl & PCI_PCIE_LCSR_ASPM_L1) ? "En" : "Dis",do { ; } while (0)
   sc->sc_ltr_enabled ? "En" : "Dis"))do { ; } while (0);
2129}

2131/*
* Start up NIC's basic functionality after it has been reset
* e.g. after platform boot or shutdown.
* NOTE:  This does not load uCode nor start the embedded processor
*/
2136int
2137iwx_apm_init(struct iwx_softc *sc)
2138{
int err = 0;

/*
* Disable L0s without affecting L1;
*  don't wait for ICH L0s (ICH bug W/A)
*/
IWX_SETBITS(sc, IWX_CSR_GIO_CHICKEN_BITS,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x100))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x100)))))
 | ((0x00800000))))))
   IWX_CSR_GIO_CHICKEN_BITS_REG_BIT_L1A_NO_L0S_RX)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x100))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x100)))))
 | ((0x00800000))))));

/* Set FH wait threshold to maximum (HW error during stress W/A) */
IWX_SETBITS(sc, IWX_CSR_DBG_HPET_MEM_REG, IWX_CSR_DBG_HPET_MEM_REG_VAL)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x240))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x240)))))
 | ((0xFFFF0000))))));

/*
* Enable HAP INTA (interrupt from management bus) to
* wake device's PCI Express link L1a -> L0s
*/
IWX_SETBITS(sc, IWX_CSR_HW_IF_CONFIG_REG,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x000))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x000)))))
 | ((0x00080000))))))
   IWX_CSR_HW_IF_CONFIG_REG_BIT_HAP_WAKE_L1A)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x000))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x000)))))
 | ((0x00080000))))));

iwx_apm_config(sc);

/*
* Set "initialization complete" bit to move adapter from
* D0U* --> D0A* (powered-up active) state.
*/
IWX_SETBITS(sc, IWX_CSR_GP_CNTRL, IWX_CSR_GP_CNTRL_REG_FLAG_INIT_DONE)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 | ((0x00000004))))));

/*
* Wait for clock stabilization; once stabilized, access to
* device-internal resources is supported, e.g. iwx_write_prph()
* and accesses to uCode SRAM.
*/
if (!iwx_poll_bit(sc, IWX_CSR_GP_CNTRL(0x024),
   IWX_CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY(0x00000001),
   IWX_CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY(0x00000001), 25000)) {
printf("%s: timeout waiting for clock stabilization\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
err = ETIMEDOUT60;
goto out;
}
out:
if (err)
printf("%s: apm init error %d\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
2183}

2185void
2186iwx_apm_stop(struct iwx_softc *sc)
2187{
IWX_SETBITS(sc, IWX_CSR_DBG_LINK_PWR_MGMT_REG,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x250))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x250)))))
 | ((0x80000000))))))
   IWX_CSR_RESET_LINK_PWR_MGMT_DISABLED)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x250))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x250)))))
 | ((0x80000000))))));
IWX_SETBITS(sc, IWX_CSR_HW_IF_CONFIG_REG,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x000))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x000)))))
 | ((0x08000000) | (0x10000000))))))
   IWX_CSR_HW_IF_CONFIG_REG_PREPARE |(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x000))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x000)))))
 | ((0x08000000) | (0x10000000))))))
   IWX_CSR_HW_IF_CONFIG_REG_ENABLE_PME)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x000))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x000)))))
 | ((0x08000000) | (0x10000000))))));
DELAY(1000)(*delay_func)(1000);
IWX_CLRBITS(sc, IWX_CSR_DBG_LINK_PWR_MGMT_REG,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x250))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x250)))))
 & ~((0x80000000))))))
   IWX_CSR_RESET_LINK_PWR_MGMT_DISABLED)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x250))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x250)))))
 & ~((0x80000000))))));
DELAY(5000)(*delay_func)(5000);

/* stop device's busmaster DMA activity */
IWX_SETBITS(sc, IWX_CSR_RESET, IWX_CSR_RESET_REG_FLAG_STOP_MASTER)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x020))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x020)))))
 | ((0x00000200))))));

if (!iwx_poll_bit(sc, IWX_CSR_RESET(0x020),
   IWX_CSR_RESET_REG_FLAG_MASTER_DISABLED(0x00000100),
   IWX_CSR_RESET_REG_FLAG_MASTER_DISABLED(0x00000100), 100))
printf("%s: timeout waiting for master\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));

/*
* Clear "initialization complete" bit to move adapter from
* D0A* (powered-up Active) --> D0U* (Uninitialized) state.
*/
IWX_CLRBITS(sc, IWX_CSR_GP_CNTRL,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 & ~((0x00000004))))))
   IWX_CSR_GP_CNTRL_REG_FLAG_INIT_DONE)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 & ~((0x00000004))))));
2212}

2214void
2215iwx_init_msix_hw(struct iwx_softc *sc)
2216{
iwx_conf_msix_hw(sc, 0);

if (!sc->sc_msix)
return;

sc->sc_fh_init_mask = ~IWX_READ(sc, IWX_CSR_MSIX_FH_INT_MASK_AD)(((sc)->sc_st)->read_4(((sc)->sc_sh), ((((0x2000) + 0x804
)))));
sc->sc_fh_mask = sc->sc_fh_init_mask;
sc->sc_hw_init_mask = ~IWX_READ(sc, IWX_CSR_MSIX_HW_INT_MASK_AD)(((sc)->sc_st)->read_4(((sc)->sc_sh), ((((0x2000) + 0x80C
)))));
sc->sc_hw_mask = sc->sc_hw_init_mask;
2226}

2228void
2229iwx_conf_msix_hw(struct iwx_softc *sc, int stopped)
2230{
int vector = 0;

if (!sc->sc_msix) {
/* Newer chips default to MSIX. */
if (!stopped && iwx_nic_lock(sc)) {
	iwx_write_prph(sc, IWX_UREG_CHICK0xa05c00,
	    IWX_UREG_CHICK_MSI_ENABLE(1 << 24));
	iwx_nic_unlock(sc);
}
return;
}

if (!stopped && iwx_nic_lock(sc)) {
iwx_write_prph(sc, IWX_UREG_CHICK0xa05c00, IWX_UREG_CHICK_MSIX_ENABLE(1 << 25));
iwx_nic_unlock(sc);
}

/* Disable all interrupts */
IWX_WRITE(sc, IWX_CSR_MSIX_FH_INT_MASK_AD, ~0)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), ((~0))));
IWX_WRITE(sc, IWX_CSR_MSIX_HW_INT_MASK_AD, ~0)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), ((~0))));

/* Map fallback-queue (command/mgmt) to a single vector */
IWX_WRITE_1(sc, IWX_CSR_MSIX_RX_IVAR(0),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x880) + (0)))), ((vector | (1 << 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x880) + (0)))), ((vector | (1 << 7)))));
/* Map RSS queue (data) to the same vector */
IWX_WRITE_1(sc, IWX_CSR_MSIX_RX_IVAR(1),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x880) + (1)))), ((vector | (1 << 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x880) + (1)))), ((vector | (1 << 7)))));

/* Enable the RX queues cause interrupts */
IWX_CLRBITS(sc, IWX_CSR_MSIX_FH_INT_MASK_AD,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x804))))) & ~(IWX_MSIX_FH_INT_CAUSES_Q0 | IWX_MSIX_FH_INT_CAUSES_Q1
)))))
   IWX_MSIX_FH_INT_CAUSES_Q0 | IWX_MSIX_FH_INT_CAUSES_Q1)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x804))))) & ~(IWX_MSIX_FH_INT_CAUSES_Q0 | IWX_MSIX_FH_INT_CAUSES_Q1
)))));

/* Map non-RX causes to the same vector */
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_D2S_CH0_NUM),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_D2S_CH0_NUM)))), ((vector | (1
 << 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_D2S_CH0_NUM)))), ((vector | (1
 << 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_D2S_CH1_NUM),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_D2S_CH1_NUM)))), ((vector | (1
 << 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_D2S_CH1_NUM)))), ((vector | (1
 << 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_S2D),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_S2D)))), ((vector | (1 <<
 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_S2D)))), ((vector | (1 <<
 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_FH_ERR),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_FH_ERR)))), ((vector | (1 <<
 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_FH_ERR)))), ((vector | (1 <<
 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_REG_ALIVE),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_ALIVE)))), ((vector | (1 <<
 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_ALIVE)))), ((vector | (1 <<
 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_REG_WAKEUP),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_WAKEUP)))), ((vector | (1 <<
 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_WAKEUP)))), ((vector | (1 <<
 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_REG_IML),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_IML)))), ((vector | (1 <<
 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_IML)))), ((vector | (1 <<
 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_REG_CT_KILL),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_CT_KILL)))), ((vector | (1
 << 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_CT_KILL)))), ((vector | (1
 << 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_REG_RF_KILL),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_RF_KILL)))), ((vector | (1
 << 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_RF_KILL)))), ((vector | (1
 << 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_REG_PERIODIC),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_PERIODIC)))), ((vector | (
<< 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_PERIODIC)))), ((vector | (
<< 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_REG_SW_ERR),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_SW_ERR)))), ((vector | (1 <<
 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_SW_ERR)))), ((vector | (1 <<
 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_REG_SCD),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_SCD)))), ((vector | (1 <<
 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_SCD)))), ((vector | (1 <<
 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_REG_FH_TX),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_FH_TX)))), ((vector | (1 <<
 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_FH_TX)))), ((vector | (1 <<
 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_REG_HW_ERR),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_HW_ERR)))), ((vector | (1 <<
 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_HW_ERR)))), ((vector | (1 <<
 7)))));
IWX_WRITE_1(sc, IWX_CSR_MSIX_IVAR(IWX_MSIX_IVAR_CAUSE_REG_HAP),(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_HAP)))), ((vector | (1 <<
 7)))))
   vector | IWX_MSIX_NON_AUTO_CLEAR_CAUSE)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((((0x2000) +
 0x890) + (IWX_MSIX_IVAR_CAUSE_REG_HAP)))), ((vector | (1 <<
 7)))));

/* Enable non-RX causes interrupts */
IWX_CLRBITS(sc, IWX_CSR_MSIX_FH_INT_MASK_AD,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x804))))) & ~(IWX_MSIX_FH_INT_CAUSES_D2S_CH0_NUM
 | IWX_MSIX_FH_INT_CAUSES_D2S_CH1_NUM | IWX_MSIX_FH_INT_CAUSES_S2D
 | IWX_MSIX_FH_INT_CAUSES_FH_ERR)))))
   IWX_MSIX_FH_INT_CAUSES_D2S_CH0_NUM |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x804))))) & ~(IWX_MSIX_FH_INT_CAUSES_D2S_CH0_NUM
 | IWX_MSIX_FH_INT_CAUSES_D2S_CH1_NUM | IWX_MSIX_FH_INT_CAUSES_S2D
 | IWX_MSIX_FH_INT_CAUSES_FH_ERR)))))
   IWX_MSIX_FH_INT_CAUSES_D2S_CH1_NUM |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x804))))) & ~(IWX_MSIX_FH_INT_CAUSES_D2S_CH0_NUM
 | IWX_MSIX_FH_INT_CAUSES_D2S_CH1_NUM | IWX_MSIX_FH_INT_CAUSES_S2D
 | IWX_MSIX_FH_INT_CAUSES_FH_ERR)))))
   IWX_MSIX_FH_INT_CAUSES_S2D |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x804))))) & ~(IWX_MSIX_FH_INT_CAUSES_D2S_CH0_NUM
 | IWX_MSIX_FH_INT_CAUSES_D2S_CH1_NUM | IWX_MSIX_FH_INT_CAUSES_S2D
 | IWX_MSIX_FH_INT_CAUSES_FH_ERR)))))
   IWX_MSIX_FH_INT_CAUSES_FH_ERR)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x804))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x804))))) & ~(IWX_MSIX_FH_INT_CAUSES_D2S_CH0_NUM
 | IWX_MSIX_FH_INT_CAUSES_D2S_CH1_NUM | IWX_MSIX_FH_INT_CAUSES_S2D
 | IWX_MSIX_FH_INT_CAUSES_FH_ERR)))));
IWX_CLRBITS(sc, IWX_CSR_MSIX_HW_INT_MASK_AD,(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x80C))))) & ~(IWX_MSIX_HW_INT_CAUSES_REG_ALIVE
 | IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP | IWX_MSIX_HW_INT_CAUSES_REG_IML
 | IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL | IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL
 | IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC | IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR
 | IWX_MSIX_HW_INT_CAUSES_REG_SCD | IWX_MSIX_HW_INT_CAUSES_REG_FH_TX
 | IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR | IWX_MSIX_HW_INT_CAUSES_REG_HAP
)))))
   IWX_MSIX_HW_INT_CAUSES_REG_ALIVE |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x80C))))) & ~(IWX_MSIX_HW_INT_CAUSES_REG_ALIVE
 | IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP | IWX_MSIX_HW_INT_CAUSES_REG_IML
 | IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL | IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL
 | IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC | IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR
 | IWX_MSIX_HW_INT_CAUSES_REG_SCD | IWX_MSIX_HW_INT_CAUSES_REG_FH_TX
 | IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR | IWX_MSIX_HW_INT_CAUSES_REG_HAP
)))))
   IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x80C))))) & ~(IWX_MSIX_HW_INT_CAUSES_REG_ALIVE
 | IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP | IWX_MSIX_HW_INT_CAUSES_REG_IML
 | IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL | IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL
 | IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC | IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR
 | IWX_MSIX_HW_INT_CAUSES_REG_SCD | IWX_MSIX_HW_INT_CAUSES_REG_FH_TX
 | IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR | IWX_MSIX_HW_INT_CAUSES_REG_HAP
)))))
   IWX_MSIX_HW_INT_CAUSES_REG_IML |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x80C))))) & ~(IWX_MSIX_HW_INT_CAUSES_REG_ALIVE
 | IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP | IWX_MSIX_HW_INT_CAUSES_REG_IML
 | IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL | IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL
 | IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC | IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR
 | IWX_MSIX_HW_INT_CAUSES_REG_SCD | IWX_MSIX_HW_INT_CAUSES_REG_FH_TX
 | IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR | IWX_MSIX_HW_INT_CAUSES_REG_HAP
)))))
   IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x80C))))) & ~(IWX_MSIX_HW_INT_CAUSES_REG_ALIVE
 | IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP | IWX_MSIX_HW_INT_CAUSES_REG_IML
 | IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL | IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL
 | IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC | IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR
 | IWX_MSIX_HW_INT_CAUSES_REG_SCD | IWX_MSIX_HW_INT_CAUSES_REG_FH_TX
 | IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR | IWX_MSIX_HW_INT_CAUSES_REG_HAP
)))))
   IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x80C))))) & ~(IWX_MSIX_HW_INT_CAUSES_REG_ALIVE
 | IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP | IWX_MSIX_HW_INT_CAUSES_REG_IML
 | IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL | IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL
 | IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC | IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR
 | IWX_MSIX_HW_INT_CAUSES_REG_SCD | IWX_MSIX_HW_INT_CAUSES_REG_FH_TX
 | IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR | IWX_MSIX_HW_INT_CAUSES_REG_HAP
)))))
   IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x80C))))) & ~(IWX_MSIX_HW_INT_CAUSES_REG_ALIVE
 | IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP | IWX_MSIX_HW_INT_CAUSES_REG_IML
 | IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL | IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL
 | IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC | IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR
 | IWX_MSIX_HW_INT_CAUSES_REG_SCD | IWX_MSIX_HW_INT_CAUSES_REG_FH_TX
 | IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR | IWX_MSIX_HW_INT_CAUSES_REG_HAP
)))))
   IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x80C))))) & ~(IWX_MSIX_HW_INT_CAUSES_REG_ALIVE
 | IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP | IWX_MSIX_HW_INT_CAUSES_REG_IML
 | IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL | IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL
 | IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC | IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR
 | IWX_MSIX_HW_INT_CAUSES_REG_SCD | IWX_MSIX_HW_INT_CAUSES_REG_FH_TX
 | IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR | IWX_MSIX_HW_INT_CAUSES_REG_HAP
)))))
   IWX_MSIX_HW_INT_CAUSES_REG_SCD |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x80C))))) & ~(IWX_MSIX_HW_INT_CAUSES_REG_ALIVE
 | IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP | IWX_MSIX_HW_INT_CAUSES_REG_IML
 | IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL | IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL
 | IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC | IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR
 | IWX_MSIX_HW_INT_CAUSES_REG_SCD | IWX_MSIX_HW_INT_CAUSES_REG_FH_TX
 | IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR | IWX_MSIX_HW_INT_CAUSES_REG_HAP
)))))
   IWX_MSIX_HW_INT_CAUSES_REG_FH_TX |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x80C))))) & ~(IWX_MSIX_HW_INT_CAUSES_REG_ALIVE
 | IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP | IWX_MSIX_HW_INT_CAUSES_REG_IML
 | IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL | IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL
 | IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC | IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR
 | IWX_MSIX_HW_INT_CAUSES_REG_SCD | IWX_MSIX_HW_INT_CAUSES_REG_FH_TX
 | IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR | IWX_MSIX_HW_INT_CAUSES_REG_HAP
)))))
   IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR |(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x80C))))) & ~(IWX_MSIX_HW_INT_CAUSES_REG_ALIVE
 | IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP | IWX_MSIX_HW_INT_CAUSES_REG_IML
 | IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL | IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL
 | IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC | IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR
 | IWX_MSIX_HW_INT_CAUSES_REG_SCD | IWX_MSIX_HW_INT_CAUSES_REG_FH_TX
 | IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR | IWX_MSIX_HW_INT_CAUSES_REG_HAP
)))))
   IWX_MSIX_HW_INT_CAUSES_REG_HAP)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x80C))), (((((sc)->sc_st)->read_4(((sc)->sc_sh), (
(((0x2000) + 0x80C))))) & ~(IWX_MSIX_HW_INT_CAUSES_REG_ALIVE
 | IWX_MSIX_HW_INT_CAUSES_REG_WAKEUP | IWX_MSIX_HW_INT_CAUSES_REG_IML
 | IWX_MSIX_HW_INT_CAUSES_REG_CT_KILL | IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL
 | IWX_MSIX_HW_INT_CAUSES_REG_PERIODIC | IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR
 | IWX_MSIX_HW_INT_CAUSES_REG_SCD | IWX_MSIX_HW_INT_CAUSES_REG_FH_TX
 | IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR | IWX_MSIX_HW_INT_CAUSES_REG_HAP
)))));
2313}

2315int
2316iwx_clear_persistence_bit(struct iwx_softc *sc)
2317{
uint32_t hpm, wprot;

hpm = iwx_read_prph_unlocked(sc, IWX_HPM_DEBUG0xa03440);
if (hpm != 0xa5a5a5a0 && (hpm & IWX_PERSISTENCE_BIT(1 << 12))) {
wprot = iwx_read_prph_unlocked(sc, IWX_PREG_PRPH_WPROT_220000xa04d00);
if (wprot & IWX_PREG_WFPM_ACCESS(1 << 12)) {
	printf("%s: cannot clear persistence bit\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname));
	return EPERM1;
}
iwx_write_prph_unlocked(sc, IWX_HPM_DEBUG0xa03440,
    hpm & ~IWX_PERSISTENCE_BIT(1 << 12));
}

return 0;
2333}

2335int
2336iwx_start_hw(struct iwx_softc *sc)
2337{
int err;

err = iwx_prepare_card_hw(sc);
if (err)
return err;

err = iwx_clear_persistence_bit(sc);
if (err)
return err;

/* Reset the entire device */
IWX_SETBITS(sc, IWX_CSR_RESET, IWX_CSR_RESET_REG_FLAG_SW_RESET)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x020))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x020)))))
 | ((0x00000080))))));
DELAY(5000)(*delay_func)(5000);

if (sc->sc_integrated) {
IWX_SETBITS(sc, IWX_CSR_GP_CNTRL,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 | ((0x00000004))))))
    IWX_CSR_GP_CNTRL_REG_FLAG_INIT_DONE)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 | ((0x00000004))))));
DELAY(20)(*delay_func)(20);
if (!iwx_poll_bit(sc, IWX_CSR_GP_CNTRL(0x024),
    IWX_CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY(0x00000001),
    IWX_CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY(0x00000001), 25000)) {
	printf("%s: timeout waiting for clock stabilization\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname));
	return ETIMEDOUT60;
}

err = iwx_force_power_gating(sc);
if (err)
	return err;

/* Reset the entire device */
IWX_SETBITS(sc, IWX_CSR_RESET, IWX_CSR_RESET_REG_FLAG_SW_RESET)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x020))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x020)))))
 | ((0x00000080))))));
DELAY(5000)(*delay_func)(5000);
}

err = iwx_apm_init(sc);
if (err)
return err;

iwx_init_msix_hw(sc);

iwx_enable_rfkill_int(sc);
iwx_check_rfkill(sc);

return 0;
2383}

2385void
2386iwx_stop_device(struct iwx_softc *sc)
2387{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni = ic->ic_bss;
int i;

iwx_disable_interrupts(sc);
sc->sc_flags &= ~IWX_FLAG_USE_ICT0x01;

iwx_disable_rx_dma(sc);
iwx_reset_rx_ring(sc, &sc->rxq);
for (i = 0; i < nitems(sc->txq)(sizeof((sc->txq)) / sizeof((sc->txq)[0])); i++)
iwx_reset_tx_ring(sc, &sc->txq[i]);
for (i = 0; i < IEEE80211_NUM_TID16; i++) {
struct ieee80211_tx_ba *ba = &ni->ni_tx_ba[i];
if (ba->ba_state != IEEE80211_BA_AGREED2)
	continue;
ieee80211_delba_request(ic, ni, 0, 1, i);
}

/* Make sure (redundant) we've released our request to stay awake */
IWX_CLRBITS(sc, IWX_CSR_GP_CNTRL,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 & ~((0x00000008))))))
   IWX_CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x024))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x024)))))
 & ~((0x00000008))))));
if (sc->sc_nic_locks > 0)
printf("%s: %d active NIC locks forcefully cleared\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), sc->sc_nic_locks);
sc->sc_nic_locks = 0;

/* Stop the device, and put it in low power state */
iwx_apm_stop(sc);

/* Reset the on-board processor. */
IWX_SETBITS(sc, IWX_CSR_RESET, IWX_CSR_RESET_REG_FLAG_SW_RESET)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x020))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x020)))))
 | ((0x00000080))))));
DELAY(5000)(*delay_func)(5000);

/*
* Upon stop, the IVAR table gets erased, so msi-x won't
* work. This causes a bug in RF-KILL flows, since the interrupt
* that enables radio won't fire on the correct irq, and the
* driver won't be able to handle the interrupt.
* Configure the IVAR table again after reset.
*/
iwx_conf_msix_hw(sc, 1);

/* 
* Upon stop, the APM issues an interrupt if HW RF kill is set.
* Clear the interrupt again.
*/
iwx_disable_interrupts(sc);

/* Even though we stop the HW we still want the RF kill interrupt. */
iwx_enable_rfkill_int(sc);
iwx_check_rfkill(sc);

iwx_prepare_card_hw(sc);

iwx_ctxt_info_free_paging(sc);
2443}

2445void
2446iwx_nic_config(struct iwx_softc *sc)
2447{
uint8_t radio_cfg_type, radio_cfg_step, radio_cfg_dash;
uint32_t mask, val, reg_val = 0;

radio_cfg_type = (sc->sc_fw_phy_config & IWX_FW_PHY_CFG_RADIO_TYPE(0x3 << 0)) >>
   IWX_FW_PHY_CFG_RADIO_TYPE_POS0;
radio_cfg_step = (sc->sc_fw_phy_config & IWX_FW_PHY_CFG_RADIO_STEP(0x3 << 2)) >>
   IWX_FW_PHY_CFG_RADIO_STEP_POS2;
radio_cfg_dash = (sc->sc_fw_phy_config & IWX_FW_PHY_CFG_RADIO_DASH(0x3 << 4)) >>
   IWX_FW_PHY_CFG_RADIO_DASH_POS4;

reg_val |= IWX_CSR_HW_REV_STEP(sc->sc_hw_rev)(((sc->sc_hw_rev) & 0x000000C) >> 2) <<
   IWX_CSR_HW_IF_CONFIG_REG_POS_MAC_STEP(2);
reg_val |= IWX_CSR_HW_REV_DASH(sc->sc_hw_rev)(((sc->sc_hw_rev) & 0x0000003) >> 0) <<
   IWX_CSR_HW_IF_CONFIG_REG_POS_MAC_DASH(0);

/* radio configuration */
reg_val |= radio_cfg_type << IWX_CSR_HW_IF_CONFIG_REG_POS_PHY_TYPE(10);
reg_val |= radio_cfg_step << IWX_CSR_HW_IF_CONFIG_REG_POS_PHY_STEP(14);
reg_val |= radio_cfg_dash << IWX_CSR_HW_IF_CONFIG_REG_POS_PHY_DASH(12);

mask = IWX_CSR_HW_IF_CONFIG_REG_MSK_MAC_DASH(0x00000003) |
   IWX_CSR_HW_IF_CONFIG_REG_MSK_MAC_STEP(0x0000000C) |
   IWX_CSR_HW_IF_CONFIG_REG_MSK_PHY_STEP(0x0000C000) |
   IWX_CSR_HW_IF_CONFIG_REG_MSK_PHY_DASH(0x00003000) |
   IWX_CSR_HW_IF_CONFIG_REG_MSK_PHY_TYPE(0x00000C00) |
   IWX_CSR_HW_IF_CONFIG_REG_BIT_RADIO_SI(0x00000200) |
   IWX_CSR_HW_IF_CONFIG_REG_BIT_MAC_SI(0x00000100);

val = IWX_READ(sc, IWX_CSR_HW_IF_CONFIG_REG)(((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x000)))));
val &= ~mask;
val |= reg_val;
IWX_WRITE(sc, IWX_CSR_HW_IF_CONFIG_REG, val)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x000))), (
(val))));
2480}

2482int
2483iwx_nic_rx_init(struct iwx_softc *sc)
2484{
IWX_WRITE_1(sc, IWX_CSR_INT_COALESCING, IWX_HOST_INT_TIMEOUT_DEF)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((0x004))), (
((0x40)))));

/*
* We don't configure the RFH; the firmware will do that.
* Rx descriptors are set when firmware sends an ALIVE interrupt.
*/
return 0;
2492}

2494int
2495iwx_nic_init(struct iwx_softc *sc)
2496{
int err;

iwx_apm_init(sc);
iwx_nic_config(sc);

err = iwx_nic_rx_init(sc);
if (err)
return err;

IWX_SETBITS(sc, IWX_CSR_MAC_SHADOW_REG_CTRL, 0x800fffff)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x0A8))), (
((((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x0A8)))))
 | (0x800fffff)))));

return 0;
2509}

2511/* Map a TID to an ieee80211_edca_ac category. */
2512const uint8_t iwx_tid_to_ac[IWX_MAX_TID_COUNT8] = {
EDCA_AC_BE,
EDCA_AC_BK,
EDCA_AC_BK,
EDCA_AC_BE,
EDCA_AC_VI,
EDCA_AC_VI,
EDCA_AC_VO,
EDCA_AC_VO,
2521};

2523/* Map ieee80211_edca_ac categories to firmware Tx FIFO. */
2524const uint8_t iwx_ac_to_tx_fifo[] = {
IWX_GEN2_EDCA_TX_FIFO_BE,
IWX_GEN2_EDCA_TX_FIFO_BK,
IWX_GEN2_EDCA_TX_FIFO_VI,
IWX_GEN2_EDCA_TX_FIFO_VO,
2529};

2531int
2532iwx_enable_txq(struct iwx_softc *sc, int sta_id, int qid, int tid,
  int num_slots)
2534{
struct iwx_tx_queue_cfg_cmd cmd;
struct iwx_rx_packet *pkt;
struct iwx_tx_queue_cfg_rsp *resp;
struct iwx_host_cmd hcmd = {
.id = IWX_SCD_QUEUE_CFG0x1d,
.flags = IWX_CMD_WANT_RESP,
.resp_pkt_len = sizeof(*pkt) + sizeof(*resp),
};
struct iwx_tx_ring *ring = &sc->txq[qid];
int err, fwqid;
uint32_t wr_idx;
size_t resp_len;

iwx_reset_tx_ring(sc, ring);

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));
cmd.sta_id = sta_id;
cmd.tid = tid;
cmd.flags = htole16(IWX_TX_QUEUE_CFG_ENABLE_QUEUE)((__uint16_t)((1 << 0)));
cmd.cb_size = htole32(IWX_TFD_QUEUE_CB_SIZE(num_slots))((__uint32_t)((((sizeof(num_slots) <= 4) ? (fls(num_slots)
 - 1) : (flsl(num_slots) - 1)) - 3)));
cmd.byte_cnt_addr = htole64(ring->bc_tbl.paddr)((__uint64_t)(ring->bc_tbl.paddr));
cmd.tfdq_addr = htole64(ring->desc_dma.paddr)((__uint64_t)(ring->desc_dma.paddr));

hcmd.data[0] = &cmd;
hcmd.len[0] = sizeof(cmd);

err = iwx_send_cmd(sc, &hcmd);
if (err)
return err;

pkt = hcmd.resp_pkt;
if (!pkt || (pkt->hdr.flags & IWX_CMD_FAILED_MSK0x40)) {
DPRINTF(("SCD_QUEUE_CFG command failed\n"))do { ; } while (0);
err = EIO5;
goto out;
}

resp_len = iwx_rx_packet_payload_len(pkt);
if (resp_len != sizeof(*resp)) {
DPRINTF(("SCD_QUEUE_CFG returned %zu bytes, expected %zu bytes\n", resp_len, sizeof(*resp)))do { ; } while (0);
err = EIO5;
goto out;
}

resp = (void *)pkt->data;
fwqid = le16toh(resp->queue_number)((__uint16_t)(resp->queue_number));
wr_idx = le16toh(resp->write_pointer)((__uint16_t)(resp->write_pointer));

/* Unlike iwlwifi, we do not support dynamic queue ID assignment. */
if (fwqid != qid) {
DPRINTF(("requested qid %d but %d was assigned\n", qid, fwqid))do { ; } while (0);
err = EIO5;
goto out;
}

if (wr_idx != ring->cur) {
DPRINTF(("fw write index is %d but ring is %d\n", wr_idx, ring->cur))do { ; } while (0);
err = EIO5;
goto out;
}

sc->qenablemsk |= (1 << qid);
ring->tid = tid;
2598out:
iwx_free_resp(sc, &hcmd);
return err;
2601}

2603int
2604iwx_disable_txq(struct iwx_softc *sc, int sta_id, int qid, uint8_t tid)
2605{
struct iwx_tx_queue_cfg_cmd cmd;
struct iwx_rx_packet *pkt;
struct iwx_tx_queue_cfg_rsp *resp;
struct iwx_host_cmd hcmd = {
.id = IWX_SCD_QUEUE_CFG0x1d,
.flags = IWX_CMD_WANT_RESP,
.resp_pkt_len = sizeof(*pkt) + sizeof(*resp),
};
struct iwx_tx_ring *ring = &sc->txq[qid];
int err;

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));
cmd.sta_id = sta_id;
cmd.tid = tid;
cmd.flags = htole16(0)((__uint16_t)(0)); /* clear "queue enabled" flag */
cmd.cb_size = htole32(0)((__uint32_t)(0));
cmd.byte_cnt_addr = htole64(0)((__uint64_t)(0));
cmd.tfdq_addr = htole64(0)((__uint64_t)(0));

hcmd.data[0] = &cmd;
hcmd.len[0] = sizeof(cmd);

err = iwx_send_cmd(sc, &hcmd);
if (err)
return err;

pkt = hcmd.resp_pkt;
if (!pkt || (pkt->hdr.flags & IWX_CMD_FAILED_MSK0x40)) {
DPRINTF(("SCD_QUEUE_CFG command failed\n"))do { ; } while (0);
err = EIO5;
goto out;
}

sc->qenablemsk &= ~(1 << qid);
iwx_reset_tx_ring(sc, ring);
2641out:
iwx_free_resp(sc, &hcmd);
return err;
2644}

2646void
2647iwx_post_alive(struct iwx_softc *sc)
2648{
iwx_ict_reset(sc);
2650}

2652/*
* For the high priority TE use a time event type that has similar priority to
* the FW's action scan priority.
*/
2656#define IWX_ROC_TE_TYPE_NORMAL4 IWX_TE_P2P_DEVICE_DISCOVERABLE4
2657#define IWX_ROC_TE_TYPE_MGMT_TX9 IWX_TE_P2P_CLIENT_ASSOC9

2659int
2660iwx_send_time_event_cmd(struct iwx_softc *sc,
  const struct iwx_time_event_cmd *cmd)
2662{
struct iwx_rx_packet *pkt;
struct iwx_time_event_resp *resp;
struct iwx_host_cmd hcmd = {
.id = IWX_TIME_EVENT_CMD0x29,
.flags = IWX_CMD_WANT_RESP,
.resp_pkt_len = sizeof(*pkt) + sizeof(*resp),
};
uint32_t resp_len;
int err;

hcmd.data[0] = cmd;
hcmd.len[0] = sizeof(*cmd);
err = iwx_send_cmd(sc, &hcmd);
if (err)
return err;

pkt = hcmd.resp_pkt;
if (!pkt || (pkt->hdr.flags & IWX_CMD_FAILED_MSK0x40)) {
err = EIO5;
goto out;
}

resp_len = iwx_rx_packet_payload_len(pkt);
if (resp_len != sizeof(*resp)) {
err = EIO5;
goto out;
}

resp = (void *)pkt->data;
if (le32toh(resp->status)((__uint32_t)(resp->status)) == 0)
sc->sc_time_event_uid = le32toh(resp->unique_id)((__uint32_t)(resp->unique_id));
else
err = EIO5;
2696out:
iwx_free_resp(sc, &hcmd);
return err;
2699}

2701int
2702iwx_schedule_session_protection(struct iwx_softc *sc, struct iwx_node *in,
  uint32_t duration)
2704{
struct iwx_session_prot_cmd cmd = {
.id_and_color = htole32(IWX_FW_CMD_ID_AND_COLOR(in->in_id,((__uint32_t)(((in->in_id << (0)) | (in->in_color
 << (8)))))
    in->in_color))((__uint32_t)(((in->in_id << (0)) | (in->in_color
 << (8))))),
.action = htole32(IWX_FW_CTXT_ACTION_ADD)((__uint32_t)(1)),
.conf_id = htole32(IWX_SESSION_PROTECT_CONF_ASSOC)((__uint32_t)(IWX_SESSION_PROTECT_CONF_ASSOC)),
.duration_tu = htole32(duration * IEEE80211_DUR_TU)((__uint32_t)(duration * 1024)),
};
uint32_t cmd_id;

cmd_id = iwx_cmd_id(IWX_SESSION_PROTECTION_CMD0x05, IWX_MAC_CONF_GROUP0x3, 0);
return iwx_send_cmd_pdu(sc, cmd_id, 0, sizeof(cmd), &cmd);
2716}

2718/*
* NVM read access and content parsing.  We do not support
* external NVM or writing NVM.
*/

2723uint8_t
2724iwx_fw_valid_tx_ant(struct iwx_softc *sc)
2725{
uint8_t tx_ant;

tx_ant = ((sc->sc_fw_phy_config & IWX_FW_PHY_CFG_TX_CHAIN(0xf << 16))
   >> IWX_FW_PHY_CFG_TX_CHAIN_POS16);

if (sc->sc_nvm.valid_tx_ant)
tx_ant &= sc->sc_nvm.valid_tx_ant;

return tx_ant;
2735}

2737uint8_t
2738iwx_fw_valid_rx_ant(struct iwx_softc *sc)
2739{
uint8_t rx_ant;

rx_ant = ((sc->sc_fw_phy_config & IWX_FW_PHY_CFG_RX_CHAIN(0xf << 20))
   >> IWX_FW_PHY_CFG_RX_CHAIN_POS20);

if (sc->sc_nvm.valid_rx_ant)
rx_ant &= sc->sc_nvm.valid_rx_ant;

return rx_ant;
2749}

2751void
2752iwx_init_channel_map(struct iwx_softc *sc, uint16_t *channel_profile_v3,
  uint32_t *channel_profile_v4, int nchan_profile)
2754{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_nvm_data *data = &sc->sc_nvm;
int ch_idx;
struct ieee80211_channel *channel;
uint32_t ch_flags;
int is_5ghz;
int flags, hw_value;
int nchan;
const uint8_t *nvm_channels;

if (sc->sc_uhb_supported) {
nchan = nitems(iwx_nvm_channels_uhb)(sizeof((iwx_nvm_channels_uhb)) / sizeof((iwx_nvm_channels_uhb
)[0]));
nvm_channels = iwx_nvm_channels_uhb;
} else {
nchan = nitems(iwx_nvm_channels_8000)(sizeof((iwx_nvm_channels_8000)) / sizeof((iwx_nvm_channels_8000
)[0]));
nvm_channels = iwx_nvm_channels_8000;
}

for (ch_idx = 0; ch_idx < nchan && ch_idx < nchan_profile; ch_idx++) {
if (channel_profile_v4)
	ch_flags = le32_to_cpup(channel_profile_v4 + ch_idx)(((__uint32_t)(*(const uint32_t *)(channel_profile_v4 + ch_idx
))));
else
	ch_flags = le16_to_cpup(channel_profile_v3 + ch_idx)(((__uint16_t)(*(const uint16_t *)(channel_profile_v3 + ch_idx
))));

is_5ghz = ch_idx >= IWX_NUM_2GHZ_CHANNELS14;
if (is_5ghz && !data->sku_cap_band_52GHz_enable)
	ch_flags &= ~IWX_NVM_CHANNEL_VALID(1 << 0);

hw_value = nvm_channels[ch_idx];
channel = &ic->ic_channels[hw_value];

if (!(ch_flags & IWX_NVM_CHANNEL_VALID(1 << 0))) {
	channel->ic_freq = 0;
	channel->ic_flags = 0;
	continue;
}

if (!is_5ghz) {
	flags = IEEE80211_CHAN_2GHZ0x0080;
	channel->ic_flags
	    = IEEE80211_CHAN_CCK0x0020
	    | IEEE80211_CHAN_OFDM0x0040
	    | IEEE80211_CHAN_DYN0x0400
	    | IEEE80211_CHAN_2GHZ0x0080;
} else {
	flags = IEEE80211_CHAN_5GHZ0x0100;
	channel->ic_flags =
	    IEEE80211_CHAN_A(0x0100 | 0x0040);
}
channel->ic_freq = ieee80211_ieee2mhz(hw_value, flags);

if (!(ch_flags & IWX_NVM_CHANNEL_ACTIVE(1 << 3)))
	channel->ic_flags |= IEEE80211_CHAN_PASSIVE0x0200;

if (data->sku_cap_11n_enable) {
	channel->ic_flags |= IEEE80211_CHAN_HT0x2000;
	if (ch_flags & IWX_NVM_CHANNEL_40MHZ(1 << 9))
		channel->ic_flags |= IEEE80211_CHAN_40MHZ0x8000;
}
}
2815}

2817int
2818iwx_mimo_enabled(struct iwx_softc *sc)
2819{
struct ieee80211com *ic = &sc->sc_ic;

return !sc->sc_nvm.sku_cap_mimo_disable &&
   (ic->ic_userflags & IEEE80211_F_NOMIMO0x00000008) == 0;
2824}

2826void
2827iwx_setup_ht_rates(struct iwx_softc *sc)
2828{
struct ieee80211com *ic = &sc->sc_ic;
uint8_t rx_ant;

/* TX is supported with the same MCS as RX. */
ic->ic_tx_mcs_set = IEEE80211_TX_MCS_SET_DEFINED0x01;

memset(ic->ic_sup_mcs, 0, sizeof(ic->ic_sup_mcs))__builtin_memset((ic->ic_sup_mcs), (0), (sizeof(ic->ic_sup_mcs
)));
ic->ic_sup_mcs[0] = 0xff;		/* MCS 0-7 */

if (!iwx_mimo_enabled(sc))
return;

rx_ant = iwx_fw_valid_rx_ant(sc);
if ((rx_ant & IWX_ANT_AB((1 << 0) | (1 << 1))) == IWX_ANT_AB((1 << 0) | (1 << 1)) ||
   (rx_ant & IWX_ANT_BC((1 << 1) | (1 << 2))) == IWX_ANT_BC((1 << 1) | (1 << 2)))
ic->ic_sup_mcs[1] = 0xff;	/* MCS 8-15 */
2845}

2847void
2848iwx_init_reorder_buffer(struct iwx_reorder_buffer *reorder_buf,
  uint16_t ssn, uint16_t buf_size)
2850{
reorder_buf->head_sn = ssn;
reorder_buf->num_stored = 0;
reorder_buf->buf_size = buf_size;
reorder_buf->last_amsdu = 0;
reorder_buf->last_sub_index = 0;
reorder_buf->removed = 0;
reorder_buf->valid = 0;
reorder_buf->consec_oldsn_drops = 0;
reorder_buf->consec_oldsn_ampdu_gp2 = 0;
reorder_buf->consec_oldsn_prev_drop = 0;
2861}

2863void
2864iwx_clear_reorder_buffer(struct iwx_softc *sc, struct iwx_rxba_data *rxba)
2865{
int i;
struct iwx_reorder_buffer *reorder_buf = &rxba->reorder_buf;
struct iwx_reorder_buf_entry *entry;

for (i = 0; i < reorder_buf->buf_size; i++) {
entry = &rxba->entries[i];
ml_purge(&entry->frames);
timerclear(&entry->reorder_time)(&entry->reorder_time)->tv_sec = (&entry->reorder_time
)->tv_usec = 0;
}

reorder_buf->removed = 1;
timeout_del(&reorder_buf->reorder_timer);
timerclear(&rxba->last_rx)(&rxba->last_rx)->tv_sec = (&rxba->last_rx)->
tv_usec = 0;
timeout_del(&rxba->session_timer);
rxba->baid = IWX_RX_REORDER_DATA_INVALID_BAID0x7f;
2881}

2883#define RX_REORDER_BUF_TIMEOUT_MQ_USEC(100000ULL) (100000ULL)

2885void
2886iwx_rx_ba_session_expired(void *arg)
2887{
struct iwx_rxba_data *rxba = arg;
struct iwx_softc *sc = rxba->sc;
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni = ic->ic_bss;
struct timeval now, timeout, expiry;
int s;

s = splnet()splraise(0x7);
if ((sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) == 0 &&
   ic->ic_state == IEEE80211_S_RUN &&
   rxba->baid != IWX_RX_REORDER_DATA_INVALID_BAID0x7f) {
getmicrouptime(&now);
USEC_TO_TIMEVAL(RX_REORDER_BUF_TIMEOUT_MQ_USEC(100000ULL), &timeout);
timeradd(&rxba->last_rx, &timeout, &expiry)do { (&expiry)->tv_sec = (&rxba->last_rx)->tv_sec
 + (&timeout)->tv_sec; (&expiry)->tv_usec = (&
rxba->last_rx)->tv_usec + (&timeout)->tv_usec; if
 ((&expiry)->tv_usec >= 1000000) { (&expiry)->
tv_sec++; (&expiry)->tv_usec -= 1000000; } } while (0);
if (timercmp(&now, &expiry, <)(((&now)->tv_sec == (&expiry)->tv_sec) ? ((&
now)->tv_usec < (&expiry)->tv_usec) : ((&now
)->tv_sec < (&expiry)->tv_sec))) {
	timeout_add_usec(&rxba->session_timer, rxba->timeout);
} else {
	ic->ic_stats.is_ht_rx_ba_timeout++;
	ieee80211_delba_request(ic, ni,
	    IEEE80211_REASON_TIMEOUT, 0, rxba->tid);
}
}
splx(s)spllower(s);
2911}

2913void
2914iwx_rx_bar_frame_release(struct iwx_softc *sc, struct iwx_rx_packet *pkt,
  struct mbuf_list *ml)
2916{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni = ic->ic_bss;
struct iwx_bar_frame_release *release = (void *)pkt->data;
struct iwx_reorder_buffer *buf;
struct iwx_rxba_data *rxba;
unsigned int baid, nssn, sta_id, tid;

if (iwx_rx_packet_payload_len(pkt) < sizeof(*release))
return;

baid = (le32toh(release->ba_info)((__uint32_t)(release->ba_info)) & IWX_BAR_FRAME_RELEASE_BAID_MASK0x3f000000) >>
   IWX_BAR_FRAME_RELEASE_BAID_SHIFT24;
if (baid == IWX_RX_REORDER_DATA_INVALID_BAID0x7f ||
   baid >= nitems(sc->sc_rxba_data)(sizeof((sc->sc_rxba_data)) / sizeof((sc->sc_rxba_data)
[0])))
return;

rxba = &sc->sc_rxba_data[baid];
if (rxba->baid == IWX_RX_REORDER_DATA_INVALID_BAID0x7f)
return;

tid = le32toh(release->sta_tid)((__uint32_t)(release->sta_tid)) & IWX_BAR_FRAME_RELEASE_TID_MASK0x0000000f;
sta_id = (le32toh(release->sta_tid)((__uint32_t)(release->sta_tid)) &
   IWX_BAR_FRAME_RELEASE_STA_MASK0x000001f0) >> IWX_BAR_FRAME_RELEASE_STA_SHIFT4;
if (tid != rxba->tid || rxba->sta_id != IWX_STATION_ID0)
return;

nssn = le32toh(release->ba_info)((__uint32_t)(release->ba_info)) & IWX_BAR_FRAME_RELEASE_NSSN_MASK0x00000fff;
buf = &rxba->reorder_buf;
iwx_release_frames(sc, ni, rxba, buf, nssn, ml);
2946}

2948void
2949iwx_reorder_timer_expired(void *arg)
2950{
struct mbuf_list ml = MBUF_LIST_INITIALIZER(){ ((void *)0), ((void *)0), 0 };
struct iwx_reorder_buffer *buf = arg;
struct iwx_rxba_data *rxba = iwx_rxba_data_from_reorder_buf(buf);
struct iwx_reorder_buf_entry *entries = &rxba->entries[0];
struct iwx_softc *sc = rxba->sc;
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni = ic->ic_bss;
int i, s;
uint16_t sn = 0, index = 0;
int expired = 0;
int cont = 0;
struct timeval now, timeout, expiry;

if (!buf->num_stored || buf->removed)
return;

s = splnet()splraise(0x7);
getmicrouptime(&now);
USEC_TO_TIMEVAL(RX_REORDER_BUF_TIMEOUT_MQ_USEC(100000ULL), &timeout);

for (i = 0; i < buf->buf_size ; i++) {
index = (buf->head_sn + i) % buf->buf_size;

if (ml_empty(&entries[index].frames)((&entries[index].frames)->ml_len == 0)) {
	/*
	 * If there is a hole and the next frame didn't expire
	 * we want to break and not advance SN.
	 */
	cont = 0;
	continue;
}
timeradd(&entries[index].reorder_time, &timeout, &expiry)do { (&expiry)->tv_sec = (&entries[index].reorder_time
)->tv_sec + (&timeout)->tv_sec; (&expiry)->tv_usec
 = (&entries[index].reorder_time)->tv_usec + (&timeout
)->tv_usec; if ((&expiry)->tv_usec >= 1000000) {
 (&expiry)->tv_sec++; (&expiry)->tv_usec -= 1000000
; } } while (0);
if (!cont && timercmp(&now, &expiry, <)(((&now)->tv_sec == (&expiry)->tv_sec) ? ((&
now)->tv_usec < (&expiry)->tv_usec) : ((&now
)->tv_sec < (&expiry)->tv_sec)))
	break;

expired = 1;
/* continue until next hole after this expired frame */
cont = 1;
sn = (buf->head_sn + (i + 1)) & 0xfff;
}

if (expired) {
/* SN is set to the last expired frame + 1 */
iwx_release_frames(sc, ni, rxba, buf, sn, &ml);
if_input(&sc->sc_ic.ic_ific_ac.ac_if, &ml);
ic->ic_stats.is_ht_rx_ba_window_gap_timeout++;
} else {
/*
 * If no frame expired and there are stored frames, index is now
 * pointing to the first unexpired frame - modify reorder timeout
 * accordingly.
 */
timeout_add_usec(&buf->reorder_timer,
    RX_REORDER_BUF_TIMEOUT_MQ_USEC(100000ULL));
}

splx(s)spllower(s);
3008}

3010#define IWX_MAX_RX_BA_SESSIONS16 16

3012void
3013iwx_sta_rx_agg(struct iwx_softc *sc, struct ieee80211_node *ni, uint8_t tid,
  uint16_t ssn, uint16_t winsize, int timeout_val, int start)
3015{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_add_sta_cmd cmd;
struct iwx_node *in = (void *)ni;
int err, s;
uint32_t status;
struct iwx_rxba_data *rxba = NULL((void *)0);
uint8_t baid = 0;

s = splnet()splraise(0x7);

if (start && sc->sc_rx_ba_sessions >= IWX_MAX_RX_BA_SESSIONS16) {
ieee80211_addba_req_refuse(ic, ni, tid);
splx(s)spllower(s);
return;
}

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));

cmd.sta_id = IWX_STATION_ID0;
cmd.mac_id_n_color
   = htole32(IWX_FW_CMD_ID_AND_COLOR(in->in_id, in->in_color))((__uint32_t)(((in->in_id << (0)) | (in->in_color
 << (8)))));
cmd.add_modify = IWX_STA_MODE_MODIFY1;

if (start) {
cmd.add_immediate_ba_tid = (uint8_t)tid;
cmd.add_immediate_ba_ssn = htole16(ssn)((__uint16_t)(ssn));
cmd.rx_ba_window = htole16(winsize)((__uint16_t)(winsize));
} else {
cmd.remove_immediate_ba_tid = (uint8_t)tid;
}
cmd.modify_mask = start ? IWX_STA_MODIFY_ADD_BA_TID(1 << 3) :
   IWX_STA_MODIFY_REMOVE_BA_TID(1 << 4);

status = IWX_ADD_STA_SUCCESS0x1;
err = iwx_send_cmd_pdu_status(sc, IWX_ADD_STA0x18, sizeof(cmd), &cmd,
   &status);

if (err || (status & IWX_ADD_STA_STATUS_MASK0xFF) != IWX_ADD_STA_SUCCESS0x1) {
if (start)
	ieee80211_addba_req_refuse(ic, ni, tid);
splx(s)spllower(s);
return;
}

/* Deaggregation is done in hardware. */
if (start) {
if (!(status & IWX_ADD_STA_BAID_VALID_MASK0x8000)) {
	ieee80211_addba_req_refuse(ic, ni, tid);
	splx(s)spllower(s);
	return;
}
baid = (status & IWX_ADD_STA_BAID_MASK0x7F00) >>
    IWX_ADD_STA_BAID_SHIFT8;
if (baid == IWX_RX_REORDER_DATA_INVALID_BAID0x7f ||
    baid >= nitems(sc->sc_rxba_data)(sizeof((sc->sc_rxba_data)) / sizeof((sc->sc_rxba_data)
[0]))) {
	ieee80211_addba_req_refuse(ic, ni, tid);
	splx(s)spllower(s);
	return;
}
rxba = &sc->sc_rxba_data[baid];
if (rxba->baid != IWX_RX_REORDER_DATA_INVALID_BAID0x7f) {
	ieee80211_addba_req_refuse(ic, ni, tid);
	splx(s)spllower(s);
	return;
}
rxba->sta_id = IWX_STATION_ID0;
rxba->tid = tid;
rxba->baid = baid;
rxba->timeout = timeout_val;
getmicrouptime(&rxba->last_rx);
iwx_init_reorder_buffer(&rxba->reorder_buf, ssn,
    winsize);
if (timeout_val != 0) {
	struct ieee80211_rx_ba *ba;
	timeout_add_usec(&rxba->session_timer,
	    timeout_val);
	/* XXX disable net80211's BA timeout handler */
	ba = &ni->ni_rx_ba[tid];
	ba->ba_timeout_val = 0;
}
} else {
int i;
for (i = 0; i < nitems(sc->sc_rxba_data)(sizeof((sc->sc_rxba_data)) / sizeof((sc->sc_rxba_data)
[0])); i++) {
	rxba = &sc->sc_rxba_data[i];
	if (rxba->baid ==
	    IWX_RX_REORDER_DATA_INVALID_BAID0x7f)
		continue;
	if (rxba->tid != tid)
		continue;
	iwx_clear_reorder_buffer(sc, rxba);
	break;
}
}

if (start) {
sc->sc_rx_ba_sessions++;
ieee80211_addba_req_accept(ic, ni, tid);
} else if (sc->sc_rx_ba_sessions > 0)
sc->sc_rx_ba_sessions--;

splx(s)spllower(s);
3117}

3119void
3120iwx_mac_ctxt_task(void *arg)
3121{
struct iwx_softc *sc = arg;
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_node *in = (void *)ic->ic_bss;
int err, s = splnet()splraise(0x7);

if ((sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) ||
   ic->ic_state != IEEE80211_S_RUN) {
refcnt_rele_wake(&sc->task_refs);
splx(s)spllower(s);
return;
}

err = iwx_mac_ctxt_cmd(sc, in, IWX_FW_CTXT_ACTION_MODIFY2, 1);
if (err)
printf("%s: failed to update MAC\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));

refcnt_rele_wake(&sc->task_refs);
splx(s)spllower(s);
3140}

3142void
3143iwx_phy_ctxt_task(void *arg)
3144{
struct iwx_softc *sc = arg;
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_node *in = (void *)ic->ic_bss;
struct ieee80211_node *ni = &in->in_ni;
uint8_t chains, sco;
int err, s = splnet()splraise(0x7);

if ((sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) ||
   ic->ic_state != IEEE80211_S_RUN ||
   in->in_phyctxt == NULL((void *)0)) {
refcnt_rele_wake(&sc->task_refs);
splx(s)spllower(s);
return;
}

chains = iwx_mimo_enabled(sc) ? 2 : 1;
if (ieee80211_node_supports_ht_chan40(ni))
sco = (ni->ni_htop0 & IEEE80211_HTOP0_SCO_MASK0x03);
else
sco = IEEE80211_HTOP0_SCO_SCN0;
if (in->in_phyctxt->sco != sco) {
err = iwx_phy_ctxt_update(sc, in->in_phyctxt,
    in->in_phyctxt->channel, chains, chains, 0, sco);
if (err)
	printf("%s: failed to update PHY\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
}

refcnt_rele_wake(&sc->task_refs);
splx(s)spllower(s);
3174}

3176void
3177iwx_updatechan(struct ieee80211com *ic)
3178{
struct iwx_softc *sc = ic->ic_softcic_ac.ac_if.if_softc;

if (ic->ic_state == IEEE80211_S_RUN &&
   !task_pending(&sc->newstate_task)((&sc->newstate_task)->t_flags & 1))
iwx_add_task(sc, systq, &sc->phy_ctxt_task);
3184}

3186void
3187iwx_updateprot(struct ieee80211com *ic)
3188{
struct iwx_softc *sc = ic->ic_softcic_ac.ac_if.if_softc;

if (ic->ic_state == IEEE80211_S_RUN &&
   !task_pending(&sc->newstate_task)((&sc->newstate_task)->t_flags & 1))
iwx_add_task(sc, systq, &sc->mac_ctxt_task);
3194}

3196void
3197iwx_updateslot(struct ieee80211com *ic)
3198{
struct iwx_softc *sc = ic->ic_softcic_ac.ac_if.if_softc;

if (ic->ic_state == IEEE80211_S_RUN &&
   !task_pending(&sc->newstate_task)((&sc->newstate_task)->t_flags & 1))
iwx_add_task(sc, systq, &sc->mac_ctxt_task);
3204}

3206void
3207iwx_updateedca(struct ieee80211com *ic)
3208{
struct iwx_softc *sc = ic->ic_softcic_ac.ac_if.if_softc;

if (ic->ic_state == IEEE80211_S_RUN &&
   !task_pending(&sc->newstate_task)((&sc->newstate_task)->t_flags & 1))
iwx_add_task(sc, systq, &sc->mac_ctxt_task);
3214}

3216void
3217iwx_sta_tx_agg_start(struct iwx_softc *sc, struct ieee80211_node *ni,
  uint8_t tid)
3219{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_tx_ba *ba;
int err, qid;
struct iwx_tx_ring *ring;

/* Ensure we can map this TID to an aggregation queue. */
if (tid >= IWX_MAX_TID_COUNT8)
return;

ba = &ni->ni_tx_ba[tid];
if (ba->ba_state != IEEE80211_BA_REQUESTED1)
return;

qid = sc->aggqid[tid];
if (qid == 0) {
/* Firmware should pick the next unused Tx queue. */
qid = fls(sc->qenablemsk);
}

/*
* Simply enable the queue.
* Firmware handles Tx Ba session setup and teardown.
*/
if ((sc->qenablemsk & (1 << qid)) == 0) {
if (!iwx_nic_lock(sc)) {
	ieee80211_addba_resp_refuse(ic, ni, tid,
	    IEEE80211_STATUS_UNSPECIFIED);
	return;
}
err = iwx_enable_txq(sc, IWX_STATION_ID0, qid, tid,
    IWX_TX_RING_COUNT(256));
iwx_nic_unlock(sc);
if (err) {
	printf("%s: could not enable Tx queue %d "
	    "(error %d)\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), qid, err);
	ieee80211_addba_resp_refuse(ic, ni, tid,
	    IEEE80211_STATUS_UNSPECIFIED);
	return;
}

ba->ba_winstart = 0;
} else
ba->ba_winstart = ni->ni_qos_txseqs[tid];

ba->ba_winend = (ba->ba_winstart + ba->ba_winsize - 1) & 0xfff;

ring = &sc->txq[qid];
ba->ba_timeout_val = 0;
ieee80211_addba_resp_accept(ic, ni, tid);
sc->aggqid[tid] = qid;
3270}

3272void
3273iwx_ba_task(void *arg)
3274{
struct iwx_softc *sc = arg;
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni = ic->ic_bss;
int s = splnet()splraise(0x7);
int tid;

for (tid = 0; tid < IWX_MAX_TID_COUNT8; tid++) {
if (sc->sc_flags & IWX_FLAG_SHUTDOWN0x100)
	break;
if (sc->ba_rx.start_tidmask & (1 << tid)) {
	struct ieee80211_rx_ba *ba = &ni->ni_rx_ba[tid];
	iwx_sta_rx_agg(sc, ni, tid, ba->ba_winstart,
	    ba->ba_winsize, ba->ba_timeout_val, 1);
	sc->ba_rx.start_tidmask &= ~(1 << tid);
} else if (sc->ba_rx.stop_tidmask & (1 << tid)) {
	iwx_sta_rx_agg(sc, ni, tid, 0, 0, 0, 0);
	sc->ba_rx.stop_tidmask &= ~(1 << tid);
}
}

for (tid = 0; tid < IWX_MAX_TID_COUNT8; tid++) {
if (sc->sc_flags & IWX_FLAG_SHUTDOWN0x100)
	break;
if (sc->ba_tx.start_tidmask & (1 << tid)) {
	iwx_sta_tx_agg_start(sc, ni, tid);
	sc->ba_tx.start_tidmask &= ~(1 << tid);
}
}

refcnt_rele_wake(&sc->task_refs);
splx(s)spllower(s);
3306}

3308/*
* This function is called by upper layer when an ADDBA request is received
* from another STA and before the ADDBA response is sent.
*/
3312int
3313iwx_ampdu_rx_start(struct ieee80211com *ic, struct ieee80211_node *ni,
  uint8_t tid)
3315{
struct iwx_softc *sc = IC2IFP(ic)(&(ic)->ic_ac.ac_if)->if_softc;

if (sc->sc_rx_ba_sessions >= IWX_MAX_RX_BA_SESSIONS16 ||
   tid >= IWX_MAX_TID_COUNT8)
return ENOSPC28;

if (sc->ba_rx.start_tidmask & (1 << tid))
return EBUSY16;

sc->ba_rx.start_tidmask |= (1 << tid);
iwx_add_task(sc, systq, &sc->ba_task);

return EBUSY16;
3329}

3331/*
* This function is called by upper layer on teardown of an HT-immediate
* Block Ack agreement (eg. upon receipt of a DELBA frame).
*/
3335void
3336iwx_ampdu_rx_stop(struct ieee80211com *ic, struct ieee80211_node *ni,
  uint8_t tid)
3338{
struct iwx_softc *sc = IC2IFP(ic)(&(ic)->ic_ac.ac_if)->if_softc;

if (tid >= IWX_MAX_TID_COUNT8 || sc->ba_rx.stop_tidmask & (1 << tid))
return;

sc->ba_rx.stop_tidmask = (1 << tid);
iwx_add_task(sc, systq, &sc->ba_task);
3346}

3348int
3349iwx_ampdu_tx_start(struct ieee80211com *ic, struct ieee80211_node *ni,
  uint8_t tid)
3351{
struct iwx_softc *sc = IC2IFP(ic)(&(ic)->ic_ac.ac_if)->if_softc;
struct ieee80211_tx_ba *ba = &ni->ni_tx_ba[tid];

/*
* Require a firmware version which uses an internal AUX queue.
* The value of IWX_FIRST_AGG_TX_QUEUE would be incorrect otherwise.
*/
if (sc->first_data_qid != IWX_DQA_CMD_QUEUE0 + 1)
return ENOTSUP91;

/* Ensure we can map this TID to an aggregation queue. */
if (tid >= IWX_MAX_TID_COUNT8)
return EINVAL22;

/* We only support a fixed Tx aggregation window size, for now. */
if (ba->ba_winsize != IWX_FRAME_LIMIT64)
return ENOTSUP91;

/* Is firmware already using an agg queue with this TID? */
if (sc->aggqid[tid] != 0)
return ENOSPC28;

/* Are we already processing an ADDBA request? */
if (sc->ba_tx.start_tidmask & (1 << tid))
return EBUSY16;

sc->ba_tx.start_tidmask |= (1 << tid);
iwx_add_task(sc, systq, &sc->ba_task);

return EBUSY16;
3382}

3384/* Read the mac address from WFMP registers. */
3385int
3386iwx_set_mac_addr_from_csr(struct iwx_softc *sc, struct iwx_nvm_data *data)
3387{
const uint8_t *hw_addr;
uint32_t mac_addr0, mac_addr1;

if (!iwx_nic_lock(sc))
return EBUSY16;

mac_addr0 = htole32(iwx_read_prph(sc, IWX_WFMP_MAC_ADDR_0))((__uint32_t)(iwx_read_prph(sc, 0xa03080)));
mac_addr1 = htole32(iwx_read_prph(sc, IWX_WFMP_MAC_ADDR_1))((__uint32_t)(iwx_read_prph(sc, 0xa03084)));

hw_addr = (const uint8_t *)&mac_addr0;
data->hw_addr[0] = hw_addr[3];
data->hw_addr[1] = hw_addr[2];
data->hw_addr[2] = hw_addr[1];
data->hw_addr[3] = hw_addr[0];

hw_addr = (const uint8_t *)&mac_addr1;
data->hw_addr[4] = hw_addr[1];
data->hw_addr[5] = hw_addr[0];

iwx_nic_unlock(sc);
return 0;
3409}

3411int
3412iwx_is_valid_mac_addr(const uint8_t *addr)
3413{
static const uint8_t reserved_mac[] = {
0x02, 0xcc, 0xaa, 0xff, 0xee, 0x00
};

return (memcmp(reserved_mac, addr, ETHER_ADDR_LEN)__builtin_memcmp((reserved_mac), (addr), (6)) != 0 &&
   memcmp(etherbroadcastaddr, addr, sizeof(etherbroadcastaddr))__builtin_memcmp((etherbroadcastaddr), (addr), (sizeof(etherbroadcastaddr
))) != 0 &&
   memcmp(etheranyaddr, addr, sizeof(etheranyaddr))__builtin_memcmp((etheranyaddr), (addr), (sizeof(etheranyaddr
))) != 0 &&
   !ETHER_IS_MULTICAST(addr)(*(addr) & 0x01));
3422}

3424int
3425iwx_nvm_get(struct iwx_softc *sc)
3426{
struct iwx_nvm_get_info cmd = {};
struct iwx_nvm_data *nvm = &sc->sc_nvm;
struct iwx_host_cmd hcmd = {
.flags = IWX_CMD_WANT_RESP | IWX_CMD_SEND_IN_RFKILL,
.data = { &cmd, },
.len = { sizeof(cmd) },
.id = IWX_WIDE_ID(IWX_REGULATORY_AND_NVM_GROUP,((0xc << 8) | 0x02)
    IWX_NVM_GET_INFO)((0xc << 8) | 0x02)
};
int err;
uint32_t mac_flags;
/*
* All the values in iwx_nvm_get_info_rsp v4 are the same as
* in v3, except for the channel profile part of the
* regulatory.  So we can just access the new struct, with the
* exception of the latter.
*/
struct iwx_nvm_get_info_rsp *rsp;
struct iwx_nvm_get_info_rsp_v3 *rsp_v3;
int v4 = isset(sc->sc_ucode_api, IWX_UCODE_TLV_API_REGULATORY_NVM_INFO)((sc->sc_ucode_api)[(48)>>3] & (1<<((48)&
(8 -1))));
size_t resp_len = v4 ? sizeof(*rsp) : sizeof(*rsp_v3);

hcmd.resp_pkt_len = sizeof(struct iwx_rx_packet) + resp_len;
err = iwx_send_cmd(sc, &hcmd);
if (err)
return err;

if (iwx_rx_packet_payload_len(hcmd.resp_pkt) != resp_len) {
err = EIO5;
goto out;
}

memset(nvm, 0, sizeof(*nvm))__builtin_memset((nvm), (0), (sizeof(*nvm)));

iwx_set_mac_addr_from_csr(sc, nvm);
if (!iwx_is_valid_mac_addr(nvm->hw_addr)) {
printf("%s: no valid mac address was found\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
err = EINVAL22;
goto out;
}

rsp = (void *)hcmd.resp_pkt->data;

/* Initialize general data */
nvm->nvm_version = le16toh(rsp->general.nvm_version)((__uint16_t)(rsp->general.nvm_version));
nvm->n_hw_addrs = rsp->general.n_hw_addrs;

/* Initialize MAC sku data */
mac_flags = le32toh(rsp->mac_sku.mac_sku_flags)((__uint32_t)(rsp->mac_sku.mac_sku_flags));
nvm->sku_cap_11ac_enable =
!!(mac_flags & IWX_NVM_MAC_SKU_FLAGS_802_11AC_ENABLED(1 << 3));
nvm->sku_cap_11n_enable =
!!(mac_flags & IWX_NVM_MAC_SKU_FLAGS_802_11N_ENABLED(1 << 2));
nvm->sku_cap_11ax_enable =
!!(mac_flags & IWX_NVM_MAC_SKU_FLAGS_802_11AX_ENABLED(1 << 4));
nvm->sku_cap_band_24GHz_enable =
!!(mac_flags & IWX_NVM_MAC_SKU_FLAGS_BAND_2_4_ENABLED(1 << 0));
nvm->sku_cap_band_52GHz_enable =
!!(mac_flags & IWX_NVM_MAC_SKU_FLAGS_BAND_5_2_ENABLED(1 << 1));
nvm->sku_cap_mimo_disable =
!!(mac_flags & IWX_NVM_MAC_SKU_FLAGS_MIMO_DISABLED(1 << 5));

/* Initialize PHY sku data */
nvm->valid_tx_ant = (uint8_t)le32toh(rsp->phy_sku.tx_chains)((__uint32_t)(rsp->phy_sku.tx_chains));
nvm->valid_rx_ant = (uint8_t)le32toh(rsp->phy_sku.rx_chains)((__uint32_t)(rsp->phy_sku.rx_chains));

if (le32toh(rsp->regulatory.lar_enabled)((__uint32_t)(rsp->regulatory.lar_enabled)) &&
   isset(sc->sc_enabled_capa, IWX_UCODE_TLV_CAPA_LAR_SUPPORT)((sc->sc_enabled_capa)[(1)>>3] & (1<<((1)&
(8 -1))))) {
nvm->lar_enabled = 1;
}

if (v4) {
iwx_init_channel_map(sc, NULL((void *)0),
    rsp->regulatory.channel_profile, IWX_NUM_CHANNELS110);
} else {
rsp_v3 = (void *)rsp;
iwx_init_channel_map(sc, rsp_v3->regulatory.channel_profile,
    NULL((void *)0), IWX_NUM_CHANNELS_V151);
}
3506out:
iwx_free_resp(sc, &hcmd);
return err;
3509}

3511int
3512iwx_load_firmware(struct iwx_softc *sc)
3513{
struct iwx_fw_sects *fws;
int err;

splassert(IPL_NET)do { if (splassert_ctl > 0) { splassert_check(0x7, __func__
); } } while (0);

sc->sc_uc.uc_intr = 0;
sc->sc_uc.uc_ok = 0;

fws = &sc->sc_fw.fw_sects[IWX_UCODE_TYPE_REGULAR];
err = iwx_ctxt_info_init(sc, fws);
if (err) {
printf("%s: could not init context info\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return err;
}

/* wait for the firmware to load */
err = tsleep_nsec(&sc->sc_uc, 0, "iwxuc", SEC_TO_NSEC(1));
if (err || !sc->sc_uc.uc_ok) {
printf("%s: could not load firmware, %d\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
iwx_ctxt_info_free_paging(sc);
}

iwx_ctxt_info_free_fw_img(sc);

if (!sc->sc_uc.uc_ok)
return EINVAL22;

return err;
3542}

3544int
3545iwx_start_fw(struct iwx_softc *sc)
3546{
int err;

IWX_WRITE(sc, IWX_CSR_INT, ~0)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x008))), (
(~0))));

iwx_disable_interrupts(sc);

/* make sure rfkill handshake bits are cleared */
IWX_WRITE(sc, IWX_CSR_UCODE_DRV_GP1_CLR, IWX_CSR_UCODE_SW_BIT_RFKILL)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x05c))), (
((0x00000002)))));
IWX_WRITE(sc, IWX_CSR_UCODE_DRV_GP1_CLR,(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x05c))), (
((0x00000004)))))
   IWX_CSR_UCODE_DRV_GP1_BIT_CMD_BLOCKED)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x05c))), (
((0x00000004)))));

/* clear (again), then enable firmware load interrupt */
IWX_WRITE(sc, IWX_CSR_INT, ~0)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x008))), (
(~0))));

err = iwx_nic_init(sc);
if (err) {
printf("%s: unable to init nic\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return err;
}

iwx_enable_fwload_interrupt(sc);

return iwx_load_firmware(sc);
3570}

3572int
3573iwx_send_tx_ant_cfg(struct iwx_softc *sc, uint8_t valid_tx_ant)
3574{
struct iwx_tx_ant_cfg_cmd tx_ant_cmd = {
.valid = htole32(valid_tx_ant)((__uint32_t)(valid_tx_ant)),
};

return iwx_send_cmd_pdu(sc, IWX_TX_ANT_CONFIGURATION_CMD0x98,
   0, sizeof(tx_ant_cmd), &tx_ant_cmd);
3581}

3583int
3584iwx_send_phy_cfg_cmd(struct iwx_softc *sc)
3585{
struct iwx_phy_cfg_cmd phy_cfg_cmd;

phy_cfg_cmd.phy_cfg = htole32(sc->sc_fw_phy_config)((__uint32_t)(sc->sc_fw_phy_config));
phy_cfg_cmd.calib_control.event_trigger =
   sc->sc_default_calib[IWX_UCODE_TYPE_REGULAR].event_trigger;
phy_cfg_cmd.calib_control.flow_trigger =
   sc->sc_default_calib[IWX_UCODE_TYPE_REGULAR].flow_trigger;

return iwx_send_cmd_pdu(sc, IWX_PHY_CONFIGURATION_CMD0x6a, 0,
   sizeof(phy_cfg_cmd), &phy_cfg_cmd);
3596}

3598int
3599iwx_send_dqa_cmd(struct iwx_softc *sc)
3600{
struct iwx_dqa_enable_cmd dqa_cmd = {
.cmd_queue = htole32(IWX_DQA_CMD_QUEUE)((__uint32_t)(0)),
};
uint32_t cmd_id;

cmd_id = iwx_cmd_id(IWX_DQA_ENABLE_CMD0x00, IWX_DATA_PATH_GROUP0x5, 0);
return iwx_send_cmd_pdu(sc, cmd_id, 0, sizeof(dqa_cmd), &dqa_cmd);
3608}

3610int
3611iwx_load_ucode_wait_alive(struct iwx_softc *sc)
3612{
int err;

err = iwx_read_firmware(sc);
if (err)
return err;

err = iwx_start_fw(sc);
if (err)
return err;

iwx_post_alive(sc);

return 0;
3626}

3628int
3629iwx_run_init_mvm_ucode(struct iwx_softc *sc, int readnvm)
3630{
const int wait_flags = IWX_INIT_COMPLETE0x01;
struct iwx_nvm_access_complete_cmd nvm_complete = {};
struct iwx_init_extended_cfg_cmd init_cfg = {
.init_flags = htole32(IWX_INIT_NVM)((__uint32_t)((1 << 1))),
};
int err, s;

if ((sc->sc_flags & IWX_FLAG_RFKILL0x02) && !readnvm) {
printf("%s: radio is disabled by hardware switch\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
return EPERM1;
}

s = splnet()splraise(0x7);
sc->sc_init_complete = 0;
err = iwx_load_ucode_wait_alive(sc);
if (err) {
printf("%s: failed to load init firmware\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
splx(s)spllower(s);
return err;
}

/*
* Send init config command to mark that we are sending NVM
* access commands
*/
err = iwx_send_cmd_pdu(sc, IWX_WIDE_ID(IWX_SYSTEM_GROUP,((0x2 << 8) | 0x03)
   IWX_INIT_EXTENDED_CFG_CMD)((0x2 << 8) | 0x03), 0, sizeof(init_cfg), &init_cfg);
if (err) {
splx(s)spllower(s);
return err;
}

err = iwx_send_cmd_pdu(sc, IWX_WIDE_ID(IWX_REGULATORY_AND_NVM_GROUP,((0xc << 8) | 0x00)
   IWX_NVM_ACCESS_COMPLETE)((0xc << 8) | 0x00), 0, sizeof(nvm_complete), &nvm_complete);
if (err) {
splx(s)spllower(s);
return err;
}

/* Wait for the init complete notification from the firmware. */
while ((sc->sc_init_complete & wait_flags) != wait_flags) {
err = tsleep_nsec(&sc->sc_init_complete, 0, "iwxinit",
    SEC_TO_NSEC(2));
if (err) {
	splx(s)spllower(s);
	return err;
}
}
splx(s)spllower(s);
if (readnvm) {
err = iwx_nvm_get(sc);
if (err) {
	printf("%s: failed to read nvm\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
	return err;
}
if (IEEE80211_ADDR_EQ(etheranyaddr, sc->sc_ic.ic_myaddr)(__builtin_memcmp((etheranyaddr), (sc->sc_ic.ic_myaddr), (
6)) == 0))
	IEEE80211_ADDR_COPY(sc->sc_ic.ic_myaddr,__builtin_memcpy((sc->sc_ic.ic_myaddr), (sc->sc_nvm.hw_addr
), (6))
	    sc->sc_nvm.hw_addr)__builtin_memcpy((sc->sc_ic.ic_myaddr), (sc->sc_nvm.hw_addr
), (6));

}
return 0;
3693}

3695int
3696iwx_config_ltr(struct iwx_softc *sc)
3697{
struct iwx_ltr_config_cmd cmd = {
.flags = htole32(IWX_LTR_CFG_FLAG_FEATURE_ENABLE)((__uint32_t)(0x00000001)),
};

if (!sc->sc_ltr_enabled)
return 0;

return iwx_send_cmd_pdu(sc, IWX_LTR_CONFIG0xee, 0, sizeof(cmd), &cmd);
3706}

3708void
3709iwx_update_rx_desc(struct iwx_softc *sc, struct iwx_rx_ring *ring, int idx)
3710{
struct iwx_rx_data *data = &ring->data[idx];

((uint64_t *)ring->desc)[idx] =
   htole64(data->map->dm_segs[0].ds_addr | (idx & 0x0fff))((__uint64_t)(data->map->dm_segs[0].ds_addr | (idx &
 0x0fff)));
bus_dmamap_sync(sc->sc_dmat, ring->free_desc_dma.map,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
free_desc_dma.map), (idx * sizeof(uint64_t)), (sizeof(uint64_t
)), (0x04))
   idx * sizeof(uint64_t), sizeof(uint64_t),(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
free_desc_dma.map), (idx * sizeof(uint64_t)), (sizeof(uint64_t
)), (0x04))
   BUS_DMASYNC_PREWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
free_desc_dma.map), (idx * sizeof(uint64_t)), (sizeof(uint64_t
)), (0x04));
3718}

3720int
3721iwx_rx_addbuf(struct iwx_softc *sc, int size, int idx)
3722{
struct iwx_rx_ring *ring = &sc->rxq;
struct iwx_rx_data *data = &ring->data[idx];
struct mbuf *m;
int err;
int fatal = 0;

m = m_gethdr(M_DONTWAIT0x0002, MT_DATA1);
if (m == NULL((void *)0))
return ENOBUFS55;

if (size <= MCLBYTES(1 << 11)) {
MCLGET(m, M_DONTWAIT)(void) m_clget((m), (0x0002), (1 << 11));
} else {
MCLGETL(m, M_DONTWAIT, IWX_RBUF_SIZE)m_clget((m), (0x0002), (4096));
}
if ((m->m_flagsm_hdr.mh_flags & M_EXT0x0001) == 0) {
m_freem(m);
return ENOBUFS55;
}

if (data->m != NULL((void *)0)) {
bus_dmamap_unload(sc->sc_dmat, data->map)(*(sc->sc_dmat)->_dmamap_unload)((sc->sc_dmat), (data
->map));
fatal = 1;
}

m->m_lenm_hdr.mh_len = m->m_pkthdrM_dat.MH.MH_pkthdr.len = m->m_extM_dat.MH.MH_dat.MH_ext.ext_size;
err = bus_dmamap_load_mbuf(sc->sc_dmat, data->map, m,(*(sc->sc_dmat)->_dmamap_load_mbuf)((sc->sc_dmat), (
data->map), (m), (0x0200|0x0001))
   BUS_DMA_READ|BUS_DMA_NOWAIT)(*(sc->sc_dmat)->_dmamap_load_mbuf)((sc->sc_dmat), (
data->map), (m), (0x0200|0x0001));
if (err) {
/* XXX */
if (fatal)
	panic("%s: could not load RX mbuf", DEVNAME(sc)((sc)->sc_dev.dv_xname));
m_freem(m);
return err;
}
data->m = m;
bus_dmamap_sync(sc->sc_dmat, data->map, 0, size, BUS_DMASYNC_PREREAD)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (size), (0x01));

/* Update RX descriptor. */
iwx_update_rx_desc(sc, ring, idx);

return 0;
3765}

3767int
3768iwx_rxmq_get_signal_strength(struct iwx_softc *sc,
  struct iwx_rx_mpdu_desc *desc)
3770{
int energy_a, energy_b;

energy_a = desc->v1.energy_a;
energy_b = desc->v1.energy_b;
energy_a = energy_a ? -energy_a : -256;
energy_b = energy_b ? -energy_b : -256;
return MAX(energy_a, energy_b)(((energy_a)>(energy_b))?(energy_a):(energy_b));
3778}

3780void
3781iwx_rx_rx_phy_cmd(struct iwx_softc *sc, struct iwx_rx_packet *pkt,
  struct iwx_rx_data *data)
3783{
struct iwx_rx_phy_info *phy_info = (void *)pkt->data;

bus_dmamap_sync(sc->sc_dmat, data->map, sizeof(*pkt),(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (sizeof(*pkt)), (sizeof(*phy_info)), (0x02))
   sizeof(*phy_info), BUS_DMASYNC_POSTREAD)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (sizeof(*pkt)), (sizeof(*phy_info)), (0x02));

memcpy(&sc->sc_last_phy_info, phy_info, sizeof(sc->sc_last_phy_info))__builtin_memcpy((&sc->sc_last_phy_info), (phy_info), (
sizeof(sc->sc_last_phy_info)));
3790}

3792/*
* Retrieve the average noise (in dBm) among receivers.
*/
3795int
3796iwx_get_noise(const struct iwx_statistics_rx_non_phy *stats)
3797{
int i, total, nbant, noise;

total = nbant = noise = 0;
for (i = 0; i < 3; i++) {
noise = letoh32(stats->beacon_silence_rssi[i])((__uint32_t)(stats->beacon_silence_rssi[i])) & 0xff;
if (noise) {
	total += noise;
	nbant++;
}
}

/* There should be at least one antenna but check anyway. */
return (nbant == 0) ? -127 : (total / nbant) - 107;
3811}

3813int
3814iwx_ccmp_decap(struct iwx_softc *sc, struct mbuf *m, struct ieee80211_node *ni,
  struct ieee80211_rxinfo *rxi)
3816{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_key *k;
struct ieee80211_frame *wh;
uint64_t pn, *prsc;
uint8_t *ivp;
uint8_t tid;
int hdrlen, hasqos;

wh = mtod(m, struct ieee80211_frame *)((struct ieee80211_frame *)((m)->m_hdr.mh_data));
hdrlen = ieee80211_get_hdrlen(wh);
ivp = (uint8_t *)wh + hdrlen;

/* find key for decryption */
k = ieee80211_get_rxkey(ic, m, ni);
if (k == NULL((void *)0) || k->k_cipher != IEEE80211_CIPHER_CCMP)
return 1;

/* Check that ExtIV bit is be set. */
if (!(ivp[3] & IEEE80211_WEP_EXTIV0x20))
return 1;

hasqos = ieee80211_has_qos(wh);
tid = hasqos ? ieee80211_get_qos(wh) & IEEE80211_QOS_TID0x000f : 0;
prsc = &k->k_rsc[tid];

/* Extract the 48-bit PN from the CCMP header. */
pn = (uint64_t)ivp[0]       |
    (uint64_t)ivp[1] <<  8 |
    (uint64_t)ivp[4] << 16 |
    (uint64_t)ivp[5] << 24 |
    (uint64_t)ivp[6] << 32 |
    (uint64_t)ivp[7] << 40;
if (rxi->rxi_flags & IEEE80211_RXI_HWDEC_SAME_PN0x00000004) {
if (pn < *prsc) {
	ic->ic_stats.is_ccmp_replays++;
	return 1;
}
} else if (pn <= *prsc) {
ic->ic_stats.is_ccmp_replays++;
return 1;
}
/* Last seen packet number is updated in ieee80211_inputm(). */

/*
* Some firmware versions strip the MIC, and some don't. It is not
* clear which of the capability flags could tell us what to expect.
* For now, keep things simple and just leave the MIC in place if
* it is present.
*
* The IV will be stripped by ieee80211_inputm().
*/
return 0;
3869}

3871int
3872iwx_rx_hwdecrypt(struct iwx_softc *sc, struct mbuf *m, uint32_t rx_pkt_status,
  struct ieee80211_rxinfo *rxi)
3874{
struct ieee80211com *ic = &sc->sc_ic;
struct ifnet *ifp = IC2IFP(ic)(&(ic)->ic_ac.ac_if);
struct ieee80211_frame *wh;
struct ieee80211_node *ni;
int ret = 0;
uint8_t type, subtype;

wh = mtod(m, struct ieee80211_frame *)((struct ieee80211_frame *)((m)->m_hdr.mh_data));

type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK0x0c;
if (type == IEEE80211_FC0_TYPE_CTL0x04)
return 0;

subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK0xf0;
if (ieee80211_has_qos(wh) && (subtype & IEEE80211_FC0_SUBTYPE_NODATA0x40))
return 0;

ni = ieee80211_find_rxnode(ic, wh);
/* Handle hardware decryption. */
if (((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK0x0c) != IEEE80211_FC0_TYPE_CTL0x04)
   && (wh->i_fc[1] & IEEE80211_FC1_PROTECTED0x40) &&
   (ni->ni_flags & IEEE80211_NODE_RXPROT0x0008) &&
   ((!IEEE80211_IS_MULTICAST(wh->i_addr1)(*(wh->i_addr1) & 0x01) &&
   ni->ni_rsncipher == IEEE80211_CIPHER_CCMP) ||
   (IEEE80211_IS_MULTICAST(wh->i_addr1)(*(wh->i_addr1) & 0x01) &&
   ni->ni_rsngroupcipher == IEEE80211_CIPHER_CCMP))) {
if ((rx_pkt_status & IWX_RX_MPDU_RES_STATUS_SEC_ENC_MSK(7 << 8)) !=
    IWX_RX_MPDU_RES_STATUS_SEC_CCM_ENC(2 << 8)) {
	ic->ic_stats.is_ccmp_dec_errs++;
	ret = 1;
	goto out;
}
/* Check whether decryption was successful or not. */
if ((rx_pkt_status &
    (IWX_RX_MPDU_RES_STATUS_DEC_DONE(1 << 11) |
    IWX_RX_MPDU_RES_STATUS_MIC_OK(1 << 6))) !=
    (IWX_RX_MPDU_RES_STATUS_DEC_DONE(1 << 11) |
    IWX_RX_MPDU_RES_STATUS_MIC_OK(1 << 6))) {
	ic->ic_stats.is_ccmp_dec_errs++;
	ret = 1;
	goto out;
}
rxi->rxi_flags |= IEEE80211_RXI_HWDEC0x00000001;
}
3919out:
if (ret)
ifp->if_ierrorsif_data.ifi_ierrors++;
ieee80211_release_node(ic, ni);
return ret;
3924}

3926void
3927iwx_rx_frame(struct iwx_softc *sc, struct mbuf *m, int chanidx,
  uint32_t rx_pkt_status, int is_shortpre, int rate_n_flags,
  uint32_t device_timestamp, struct ieee80211_rxinfo *rxi,
  struct mbuf_list *ml)
3931{
struct ieee80211com *ic = &sc->sc_ic;
struct ifnet *ifp = IC2IFP(ic)(&(ic)->ic_ac.ac_if);
struct ieee80211_frame *wh;
struct ieee80211_node *ni;
struct ieee80211_channel *bss_chan;
uint8_t saved_bssid[IEEE80211_ADDR_LEN6] = { 0 };

if (chanidx < 0 || chanidx >= nitems(ic->ic_channels)(sizeof((ic->ic_channels)) / sizeof((ic->ic_channels)[0
])))	
chanidx = ieee80211_chan2ieee(ic, ic->ic_ibss_chan);

wh = mtod(m, struct ieee80211_frame *)((struct ieee80211_frame *)((m)->m_hdr.mh_data));
ni = ieee80211_find_rxnode(ic, wh);
if (ni == ic->ic_bss) {
/* 
 * We may switch ic_bss's channel during scans.
 * Record the current channel so we can restore it later.
 */
bss_chan = ni->ni_chan;
IEEE80211_ADDR_COPY(&saved_bssid, ni->ni_macaddr)__builtin_memcpy((&saved_bssid), (ni->ni_macaddr), (6)
);
}
ni->ni_chan = &ic->ic_channels[chanidx];

if ((rxi->rxi_flags & IEEE80211_RXI_HWDEC0x00000001) &&
   iwx_ccmp_decap(sc, m, ni, rxi) != 0) {
ifp->if_ierrorsif_data.ifi_ierrors++;
m_freem(m);
ieee80211_release_node(ic, ni);
return;
}

3962#if NBPFILTER1 > 0
if (sc->sc_drvbpf != NULL((void *)0)) {
struct iwx_rx_radiotap_header *tap = &sc->sc_rxtapsc_rxtapu.th;
uint16_t chan_flags;

tap->wr_flags = 0;
if (is_shortpre)
	tap->wr_flags |= IEEE80211_RADIOTAP_F_SHORTPRE0x02;
tap->wr_chan_freq =
    htole16(ic->ic_channels[chanidx].ic_freq)((__uint16_t)(ic->ic_channels[chanidx].ic_freq));
chan_flags = ic->ic_channels[chanidx].ic_flags;
if (ic->ic_curmode != IEEE80211_MODE_11N)
	chan_flags &= ~IEEE80211_CHAN_HT0x2000;
tap->wr_chan_flags = htole16(chan_flags)((__uint16_t)(chan_flags));
tap->wr_dbm_antsignal = (int8_t)rxi->rxi_rssi;
tap->wr_dbm_antnoise = (int8_t)sc->sc_noise;
tap->wr_tsft = device_timestamp;
if (rate_n_flags & IWX_RATE_MCS_HT_MSK(1 << 8)) {
	uint8_t mcs = (rate_n_flags &
	    (IWX_RATE_HT_MCS_RATE_CODE_MSK0x7 |
	    IWX_RATE_HT_MCS_NSS_MSK(3 << 3)));
	tap->wr_rate = (0x80 | mcs);
} else {
	uint8_t rate = (rate_n_flags &
	    IWX_RATE_LEGACY_RATE_MSK0xff);
	switch (rate) {
	/* CCK rates. */
	case  10: tap->wr_rate =   2; break;
	case  20: tap->wr_rate =   4; break;
	case  55: tap->wr_rate =  11; break;
	case 110: tap->wr_rate =  22; break;
	/* OFDM rates. */
	case 0xd: tap->wr_rate =  12; break;
	case 0xf: tap->wr_rate =  18; break;
	case 0x5: tap->wr_rate =  24; break;
	case 0x7: tap->wr_rate =  36; break;
	case 0x9: tap->wr_rate =  48; break;
	case 0xb: tap->wr_rate =  72; break;
	case 0x1: tap->wr_rate =  96; break;
	case 0x3: tap->wr_rate = 108; break;
	/* Unknown rate: should not happen. */
	default:  tap->wr_rate =   0;
	}
}

bpf_mtap_hdr(sc->sc_drvbpf, tap, sc->sc_rxtap_len,
    m, BPF_DIRECTION_IN(1 << 0));
}
4010#endif
ieee80211_inputm(IC2IFP(ic)(&(ic)->ic_ac.ac_if), m, ni, rxi, ml);
/*
* ieee80211_inputm() might have changed our BSS.
* Restore ic_bss's channel if we are still in the same BSS.
*/
if (ni == ic->ic_bss && IEEE80211_ADDR_EQ(saved_bssid, ni->ni_macaddr)(__builtin_memcmp((saved_bssid), (ni->ni_macaddr), (6)) ==
 0))
ni->ni_chan = bss_chan;
ieee80211_release_node(ic, ni);
4019}

4021/*
* Drop duplicate 802.11 retransmissions
* (IEEE 802.11-2012: 9.3.2.10 "Duplicate detection and recovery")
* and handle pseudo-duplicate frames which result from deaggregation
* of A-MSDU frames in hardware.
*/
4027int
4028iwx_detect_duplicate(struct iwx_softc *sc, struct mbuf *m,
  struct iwx_rx_mpdu_desc *desc, struct ieee80211_rxinfo *rxi)
4030{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_node *in = (void *)ic->ic_bss;
struct iwx_rxq_dup_data *dup_data = &in->dup_data;
uint8_t tid = IWX_MAX_TID_COUNT8, subframe_idx;
struct ieee80211_frame *wh = mtod(m, struct ieee80211_frame *)((struct ieee80211_frame *)((m)->m_hdr.mh_data));
uint8_t type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK0x0c;
uint8_t subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK0xf0;
int hasqos = ieee80211_has_qos(wh);
uint16_t seq;

if (type == IEEE80211_FC0_TYPE_CTL0x04 ||
   (hasqos && (subtype & IEEE80211_FC0_SUBTYPE_NODATA0x40)) ||
   IEEE80211_IS_MULTICAST(wh->i_addr1)(*(wh->i_addr1) & 0x01))
return 0;

if (hasqos) {
tid = (ieee80211_get_qos(wh) & IEEE80211_QOS_TID0x000f);
if (tid > IWX_MAX_TID_COUNT8)
	tid = IWX_MAX_TID_COUNT8;
}

/* If this wasn't a part of an A-MSDU the sub-frame index will be 0 */
subframe_idx = desc->amsdu_info &
IWX_RX_MPDU_AMSDU_SUBFRAME_IDX_MASK0x7f;

seq = letoh16(*(u_int16_t *)wh->i_seq)((__uint16_t)(*(u_int16_t *)wh->i_seq)) >> IEEE80211_SEQ_SEQ_SHIFT4;
if ((wh->i_fc[1] & IEEE80211_FC1_RETRY0x08) &&
   dup_data->last_seq[tid] == seq &&
   dup_data->last_sub_frame[tid] >= subframe_idx)
return 1;

/*
* Allow the same frame sequence number for all A-MSDU subframes
* following the first subframe.
* Otherwise these subframes would be discarded as replays.
*/
if (dup_data->last_seq[tid] == seq &&
   subframe_idx > dup_data->last_sub_frame[tid] &&
   (desc->mac_flags2 & IWX_RX_MPDU_MFLG2_AMSDU0x40)) {
rxi->rxi_flags |= IEEE80211_RXI_SAME_SEQ0x00000008;
}

dup_data->last_seq[tid] = seq;
dup_data->last_sub_frame[tid] = subframe_idx;

return 0;
4077}

4079/*
* Returns true if sn2 - buffer_size < sn1 < sn2.
* To be used only in order to compare reorder buffer head with NSSN.
* We fully trust NSSN unless it is behind us due to reorder timeout.
* Reorder timeout can only bring us up to buffer_size SNs ahead of NSSN.
*/
4085int
4086iwx_is_sn_less(uint16_t sn1, uint16_t sn2, uint16_t buffer_size)
4087{
return SEQ_LT(sn1, sn2)((((u_int16_t)(sn1) - (u_int16_t)(sn2)) & 0xfff) > 2048
) && !SEQ_LT(sn1, sn2 - buffer_size)((((u_int16_t)(sn1) - (u_int16_t)(sn2 - buffer_size)) & 0xfff
) > 2048);
4089}

4091void
4092iwx_release_frames(struct iwx_softc *sc, struct ieee80211_node *ni,
  struct iwx_rxba_data *rxba, struct iwx_reorder_buffer *reorder_buf,
  uint16_t nssn, struct mbuf_list *ml)
4095{
struct iwx_reorder_buf_entry *entries = &rxba->entries[0];
uint16_t ssn = reorder_buf->head_sn;

/* ignore nssn smaller than head sn - this can happen due to timeout */
if (iwx_is_sn_less(nssn, ssn, reorder_buf->buf_size))
goto set_timer;

while (iwx_is_sn_less(ssn, nssn, reorder_buf->buf_size)) {
int index = ssn % reorder_buf->buf_size;
struct mbuf *m;
int chanidx, is_shortpre;
uint32_t rx_pkt_status, rate_n_flags, device_timestamp;
struct ieee80211_rxinfo *rxi;

/* This data is the same for all A-MSDU subframes. */
chanidx = entries[index].chanidx;
rx_pkt_status = entries[index].rx_pkt_status;
is_shortpre = entries[index].is_shortpre;
rate_n_flags = entries[index].rate_n_flags;
device_timestamp = entries[index].device_timestamp;
rxi = &entries[index].rxi;

/*
 * Empty the list. Will have more than one frame for A-MSDU.
 * Empty list is valid as well since nssn indicates frames were
 * received.
 */
while ((m = ml_dequeue(&entries[index].frames)) != NULL((void *)0)) {
	iwx_rx_frame(sc, m, chanidx, rx_pkt_status, is_shortpre,
	    rate_n_flags, device_timestamp, rxi, ml);
	reorder_buf->num_stored--;

	/*
	 * Allow the same frame sequence number and CCMP PN for
	 * all A-MSDU subframes following the first subframe.
	 * Otherwise they would be discarded as replays.
	 */
	rxi->rxi_flags |= IEEE80211_RXI_SAME_SEQ0x00000008;
	rxi->rxi_flags |= IEEE80211_RXI_HWDEC_SAME_PN0x00000004;
}

ssn = (ssn + 1) & 0xfff;
}
reorder_buf->head_sn = nssn;

4141set_timer:
if (reorder_buf->num_stored && !reorder_buf->removed) {
timeout_add_usec(&reorder_buf->reorder_timer,
    RX_REORDER_BUF_TIMEOUT_MQ_USEC(100000ULL));
} else
timeout_del(&reorder_buf->reorder_timer);
4147}

4149int
4150iwx_oldsn_workaround(struct iwx_softc *sc, struct ieee80211_node *ni, int tid,
  struct iwx_reorder_buffer *buffer, uint32_t reorder_data, uint32_t gp2)
4152{
struct ieee80211com *ic = &sc->sc_ic;

if (gp2 != buffer->consec_oldsn_ampdu_gp2) {
/* we have a new (A-)MPDU ... */

/*
 * reset counter to 0 if we didn't have any oldsn in
 * the last A-MPDU (as detected by GP2 being identical)
 */
if (!buffer->consec_oldsn_prev_drop)
	buffer->consec_oldsn_drops = 0;

/* either way, update our tracking state */
buffer->consec_oldsn_ampdu_gp2 = gp2;
} else if (buffer->consec_oldsn_prev_drop) {
/*
 * tracking state didn't change, and we had an old SN
 * indication before - do nothing in this case, we
 * already noted this one down and are waiting for the
 * next A-MPDU (by GP2)
 */
return 0;
}

/* return unless this MPDU has old SN */
if (!(reorder_data & IWX_RX_MPDU_REORDER_BA_OLD_SN0x80000000))
return 0;

/* update state */
buffer->consec_oldsn_prev_drop = 1;
buffer->consec_oldsn_drops++;

/* if limit is reached, send del BA and reset state */
if (buffer->consec_oldsn_drops == IWX_AMPDU_CONSEC_DROPS_DELBA10) {
ieee80211_delba_request(ic, ni, IEEE80211_REASON_UNSPECIFIED,
    0, tid);
buffer->consec_oldsn_prev_drop = 0;
buffer->consec_oldsn_drops = 0;
return 1;
}

return 0;
4195}

4197/*
* Handle re-ordering of frames which were de-aggregated in hardware.
* Returns 1 if the MPDU was consumed (buffered or dropped).
* Returns 0 if the MPDU should be passed to upper layer.
*/
4202int
4203iwx_rx_reorder(struct iwx_softc *sc, struct mbuf *m, int chanidx,
  struct iwx_rx_mpdu_desc *desc, int is_shortpre, int rate_n_flags,
  uint32_t device_timestamp, struct ieee80211_rxinfo *rxi,
  struct mbuf_list *ml)
4207{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_frame *wh;
struct ieee80211_node *ni;
struct iwx_rxba_data *rxba;
struct iwx_reorder_buffer *buffer;
uint32_t reorder_data = le32toh(desc->reorder_data)((__uint32_t)(desc->reorder_data));
int is_amsdu = (desc->mac_flags2 & IWX_RX_MPDU_MFLG2_AMSDU0x40);
int last_subframe =
(desc->amsdu_info & IWX_RX_MPDU_AMSDU_LAST_SUBFRAME0x80);
uint8_t tid;
uint8_t subframe_idx = (desc->amsdu_info &
   IWX_RX_MPDU_AMSDU_SUBFRAME_IDX_MASK0x7f);
struct iwx_reorder_buf_entry *entries;
int index;
uint16_t nssn, sn;
uint8_t baid, type, subtype;
int hasqos;

wh = mtod(m, struct ieee80211_frame *)((struct ieee80211_frame *)((m)->m_hdr.mh_data));
hasqos = ieee80211_has_qos(wh);
tid = hasqos ? ieee80211_get_qos(wh) & IEEE80211_QOS_TID0x000f : 0;

type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK0x0c;
subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK0xf0;

/*
* We are only interested in Block Ack requests and unicast QoS data.
*/
if (IEEE80211_IS_MULTICAST(wh->i_addr1)(*(wh->i_addr1) & 0x01))
return 0;
if (hasqos) {
if (subtype & IEEE80211_FC0_SUBTYPE_NODATA0x40)
	return 0;
} else {
if (type != IEEE80211_FC0_TYPE_CTL0x04 ||
    subtype != IEEE80211_FC0_SUBTYPE_BAR0x80)
	return 0;
}

baid = (reorder_data & IWX_RX_MPDU_REORDER_BAID_MASK0x7f000000) >>
IWX_RX_MPDU_REORDER_BAID_SHIFT24;
if (baid == IWX_RX_REORDER_DATA_INVALID_BAID0x7f ||
   baid >= nitems(sc->sc_rxba_data)(sizeof((sc->sc_rxba_data)) / sizeof((sc->sc_rxba_data)
[0])))
return 0;

rxba = &sc->sc_rxba_data[baid];
if (rxba->baid == IWX_RX_REORDER_DATA_INVALID_BAID0x7f ||
   tid != rxba->tid || rxba->sta_id != IWX_STATION_ID0)
return 0;

if (rxba->timeout != 0)
getmicrouptime(&rxba->last_rx);

/* Bypass A-MPDU re-ordering in net80211. */
rxi->rxi_flags |= IEEE80211_RXI_AMPDU_DONE0x00000002;

nssn = reorder_data & IWX_RX_MPDU_REORDER_NSSN_MASK0x00000fff;
sn = (reorder_data & IWX_RX_MPDU_REORDER_SN_MASK0x00fff000) >>
IWX_RX_MPDU_REORDER_SN_SHIFT12;

buffer = &rxba->reorder_buf;
entries = &rxba->entries[0];

if (!buffer->valid) {
if (reorder_data & IWX_RX_MPDU_REORDER_BA_OLD_SN0x80000000)
	return 0;
buffer->valid = 1;
}

ni = ieee80211_find_rxnode(ic, wh);
if (type == IEEE80211_FC0_TYPE_CTL0x04 &&
   subtype == IEEE80211_FC0_SUBTYPE_BAR0x80) {
iwx_release_frames(sc, ni, rxba, buffer, nssn, ml);
goto drop;
}

/*
* If there was a significant jump in the nssn - adjust.
* If the SN is smaller than the NSSN it might need to first go into
* the reorder buffer, in which case we just release up to it and the
* rest of the function will take care of storing it and releasing up to
* the nssn.
*/
if (!iwx_is_sn_less(nssn, buffer->head_sn + buffer->buf_size,
   buffer->buf_size) ||
   !SEQ_LT(sn, buffer->head_sn + buffer->buf_size)((((u_int16_t)(sn) - (u_int16_t)(buffer->head_sn + buffer->
buf_size)) & 0xfff) > 2048)) {
uint16_t min_sn = SEQ_LT(sn, nssn)((((u_int16_t)(sn) - (u_int16_t)(nssn)) & 0xfff) > 2048
) ? sn : nssn;
ic->ic_stats.is_ht_rx_frame_above_ba_winend++;
iwx_release_frames(sc, ni, rxba, buffer, min_sn, ml);
}

if (iwx_oldsn_workaround(sc, ni, tid, buffer, reorder_data,
   device_timestamp)) {
 /* BA session will be torn down. */
ic->ic_stats.is_ht_rx_ba_window_jump++;
goto drop;

}

/* drop any outdated packets */
if (SEQ_LT(sn, buffer->head_sn)((((u_int16_t)(sn) - (u_int16_t)(buffer->head_sn)) & 0xfff
) > 2048)) {
ic->ic_stats.is_ht_rx_frame_below_ba_winstart++;
goto drop;
}

/* release immediately if allowed by nssn and no stored frames */
if (!buffer->num_stored && SEQ_LT(sn, nssn)((((u_int16_t)(sn) - (u_int16_t)(nssn)) & 0xfff) > 2048
)) {
if (iwx_is_sn_less(buffer->head_sn, nssn, buffer->buf_size) &&
   (!is_amsdu || last_subframe))
	buffer->head_sn = nssn;
ieee80211_release_node(ic, ni);
return 0;
}

/*
* release immediately if there are no stored frames, and the sn is
* equal to the head.
* This can happen due to reorder timer, where NSSN is behind head_sn.
* When we released everything, and we got the next frame in the
* sequence, according to the NSSN we can't release immediately,
* while technically there is no hole and we can move forward.
*/
if (!buffer->num_stored && sn == buffer->head_sn) {
if (!is_amsdu || last_subframe)
	buffer->head_sn = (buffer->head_sn + 1) & 0xfff;
ieee80211_release_node(ic, ni);
return 0;
}

index = sn % buffer->buf_size;

/*
* Check if we already stored this frame
* As AMSDU is either received or not as whole, logic is simple:
* If we have frames in that position in the buffer and the last frame
* originated from AMSDU had a different SN then it is a retransmission.
* If it is the same SN then if the subframe index is incrementing it
* is the same AMSDU - otherwise it is a retransmission.
*/
if (!ml_empty(&entries[index].frames)((&entries[index].frames)->ml_len == 0)) {
if (!is_amsdu) {
	ic->ic_stats.is_ht_rx_ba_no_buf++;
	goto drop;
} else if (sn != buffer->last_amsdu ||
    buffer->last_sub_index >= subframe_idx) {
	ic->ic_stats.is_ht_rx_ba_no_buf++;
	goto drop;
}
} else {
/* This data is the same for all A-MSDU subframes. */
entries[index].chanidx = chanidx;
entries[index].is_shortpre = is_shortpre;
entries[index].rate_n_flags = rate_n_flags;
entries[index].device_timestamp = device_timestamp;
memcpy(&entries[index].rxi, rxi, sizeof(entries[index].rxi))__builtin_memcpy((&entries[index].rxi), (rxi), (sizeof(entries
[index].rxi)));
}

/* put in reorder buffer */
ml_enqueue(&entries[index].frames, m);
buffer->num_stored++;
getmicrouptime(&entries[index].reorder_time);

if (is_amsdu) {
buffer->last_amsdu = sn;
buffer->last_sub_index = subframe_idx;
}

/*
* We cannot trust NSSN for AMSDU sub-frames that are not the last.
* The reason is that NSSN advances on the first sub-frame, and may
* cause the reorder buffer to advance before all the sub-frames arrive.
* Example: reorder buffer contains SN 0 & 2, and we receive AMSDU with
* SN 1. NSSN for first sub frame will be 3 with the result of driver
* releasing SN 0,1, 2. When sub-frame 1 arrives - reorder buffer is
* already ahead and it will be dropped.
* If the last sub-frame is not on this queue - we will get frame
* release notification with up to date NSSN.
*/
if (!is_amsdu || last_subframe)
iwx_release_frames(sc, ni, rxba, buffer, nssn, ml);

ieee80211_release_node(ic, ni);
return 1;

4392drop:
m_freem(m);
ieee80211_release_node(ic, ni);
return 1;
4396}

4398void
4399iwx_rx_mpdu_mq(struct iwx_softc *sc, struct mbuf *m, void *pktdata,
  size_t maxlen, struct mbuf_list *ml)
4401{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_rxinfo rxi;
struct iwx_rx_mpdu_desc *desc;
uint32_t len, hdrlen, rate_n_flags, device_timestamp;
int rssi;
uint8_t chanidx;
uint16_t phy_info;

desc = (struct iwx_rx_mpdu_desc *)pktdata;

if (!(desc->status & htole16(IWX_RX_MPDU_RES_STATUS_CRC_OK)((__uint16_t)((1 << 0)))) ||
   !(desc->status & htole16(IWX_RX_MPDU_RES_STATUS_OVERRUN_OK)((__uint16_t)((1 << 1))))) {
m_freem(m);
return; /* drop */
}

len = le16toh(desc->mpdu_len)((__uint16_t)(desc->mpdu_len));
if (ic->ic_opmode == IEEE80211_M_MONITOR) {
/* Allow control frames in monitor mode. */
if (len < sizeof(struct ieee80211_frame_cts)) {
	ic->ic_stats.is_rx_tooshort++;
	IC2IFP(ic)(&(ic)->ic_ac.ac_if)->if_ierrorsif_data.ifi_ierrors++;
	m_freem(m);
	return;
}
} else if (len < sizeof(struct ieee80211_frame)) {
ic->ic_stats.is_rx_tooshort++;
IC2IFP(ic)(&(ic)->ic_ac.ac_if)->if_ierrorsif_data.ifi_ierrors++;
m_freem(m);
return;
}
if (len > maxlen - sizeof(*desc)) {
IC2IFP(ic)(&(ic)->ic_ac.ac_if)->if_ierrorsif_data.ifi_ierrors++;
m_freem(m);
return;
}

m->m_datam_hdr.mh_data = pktdata + sizeof(*desc);
m->m_pkthdrM_dat.MH.MH_pkthdr.len = m->m_lenm_hdr.mh_len = len;

/* Account for padding following the frame header. */
if (desc->mac_flags2 & IWX_RX_MPDU_MFLG2_PAD0x20) {
struct ieee80211_frame *wh = mtod(m, struct ieee80211_frame *)((struct ieee80211_frame *)((m)->m_hdr.mh_data));
int type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK0x0c;
if (type == IEEE80211_FC0_TYPE_CTL0x04) {
	switch (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK0xf0) {
	case IEEE80211_FC0_SUBTYPE_CTS0xc0:
		hdrlen = sizeof(struct ieee80211_frame_cts);
		break;
	case IEEE80211_FC0_SUBTYPE_ACK0xd0:
		hdrlen = sizeof(struct ieee80211_frame_ack);
		break;
	default:
		hdrlen = sizeof(struct ieee80211_frame_min);
		break;
	}
} else
	hdrlen = ieee80211_get_hdrlen(wh);

if ((le16toh(desc->status)((__uint16_t)(desc->status)) &
    IWX_RX_MPDU_RES_STATUS_SEC_ENC_MSK(7 << 8)) ==
    IWX_RX_MPDU_RES_STATUS_SEC_CCM_ENC(2 << 8)) {
	/* Padding is inserted after the IV. */
	hdrlen += IEEE80211_CCMP_HDRLEN8;
}

memmove(m->m_data + 2, m->m_data, hdrlen)__builtin_memmove((m->m_hdr.mh_data + 2), (m->m_hdr.mh_data
), (hdrlen));
m_adj(m, 2);
}

memset(&rxi, 0, sizeof(rxi))__builtin_memset((&rxi), (0), (sizeof(rxi)));

/*
* Hardware de-aggregates A-MSDUs and copies the same MAC header
* in place for each subframe. But it leaves the 'A-MSDU present'
* bit set in the frame header. We need to clear this bit ourselves.
* (XXX This workaround is not required on AX200/AX201 devices that
* have been tested by me, but it's unclear when this problem was
* fixed in the hardware. It definitely affects the 9k generation.
* Leaving this in place for now since some 9k/AX200 hybrids seem
* to exist that we may eventually add support for.)
*
* And we must allow the same CCMP PN for subframes following the
* first subframe. Otherwise they would be discarded as replays.
*/
if (desc->mac_flags2 & IWX_RX_MPDU_MFLG2_AMSDU0x40) {
struct ieee80211_frame *wh = mtod(m, struct ieee80211_frame *)((struct ieee80211_frame *)((m)->m_hdr.mh_data));
uint8_t subframe_idx = (desc->amsdu_info &
    IWX_RX_MPDU_AMSDU_SUBFRAME_IDX_MASK0x7f);
if (subframe_idx > 0)
	rxi.rxi_flags |= IEEE80211_RXI_HWDEC_SAME_PN0x00000004;
if (ieee80211_has_qos(wh) && ieee80211_has_addr4(wh) &&
    m->m_lenm_hdr.mh_len >= sizeof(struct ieee80211_qosframe_addr4)) {
	struct ieee80211_qosframe_addr4 *qwh4 = mtod(m,((struct ieee80211_qosframe_addr4 *)((m)->m_hdr.mh_data))
	    struct ieee80211_qosframe_addr4 *)((struct ieee80211_qosframe_addr4 *)((m)->m_hdr.mh_data));
	qwh4->i_qos[0] &= htole16(~IEEE80211_QOS_AMSDU)((__uint16_t)(~0x0080));
} else if (ieee80211_has_qos(wh) &&
    m->m_lenm_hdr.mh_len >= sizeof(struct ieee80211_qosframe)) {
	struct ieee80211_qosframe *qwh = mtod(m,((struct ieee80211_qosframe *)((m)->m_hdr.mh_data))
	    struct ieee80211_qosframe *)((struct ieee80211_qosframe *)((m)->m_hdr.mh_data));
	qwh->i_qos[0] &= htole16(~IEEE80211_QOS_AMSDU)((__uint16_t)(~0x0080));
}	
}

/*
* Verify decryption before duplicate detection. The latter uses
* the TID supplied in QoS frame headers and this TID is implicitly
* verified as part of the CCMP nonce.
*/
if (iwx_rx_hwdecrypt(sc, m, le16toh(desc->status)((__uint16_t)(desc->status)), &rxi)) {
m_freem(m);
return;
}

if (iwx_detect_duplicate(sc, m, desc, &rxi)) {
m_freem(m);
return;
}

phy_info = le16toh(desc->phy_info)((__uint16_t)(desc->phy_info));
rate_n_flags = le32toh(desc->v1.rate_n_flags)((__uint32_t)(desc->v1.rate_n_flags));
chanidx = desc->v1.channel;
device_timestamp = desc->v1.gp2_on_air_rise;

rssi = iwx_rxmq_get_signal_strength(sc, desc);
rssi = (0 - IWX_MIN_DBM-100) + rssi;	/* normalize */
rssi = MIN(rssi, ic->ic_max_rssi)(((rssi)<(ic->ic_max_rssi))?(rssi):(ic->ic_max_rssi)
);	/* clip to max. 100% */

rxi.rxi_rssi = rssi;
rxi.rxi_tstamp = le64toh(desc->v1.tsf_on_air_rise)((__uint64_t)(desc->v1.tsf_on_air_rise));

if (iwx_rx_reorder(sc, m, chanidx, desc,
   (phy_info & IWX_RX_MPDU_PHY_SHORT_PREAMBLE(1 << 7)),
   rate_n_flags, device_timestamp, &rxi, ml))
return;

iwx_rx_frame(sc, m, chanidx, le16toh(desc->status)((__uint16_t)(desc->status)),
   (phy_info & IWX_RX_MPDU_PHY_SHORT_PREAMBLE(1 << 7)),
   rate_n_flags, device_timestamp, &rxi, ml);
4541}

4543void
4544iwx_clear_tx_desc(struct iwx_softc *sc, struct iwx_tx_ring *ring, int idx)
4545{
struct iwx_tfh_tfd *desc = &ring->desc[idx];
uint8_t num_tbs = le16toh(desc->num_tbs)((__uint16_t)(desc->num_tbs)) & 0x1f;
int i;

/* First TB is never cleared - it is bidirectional DMA data. */
for (i = 1; i < num_tbs; i++) {
struct iwx_tfh_tb *tb = &desc->tbs[i];
memset(tb, 0, sizeof(*tb))__builtin_memset((tb), (0), (sizeof(*tb)));
}
desc->num_tbs = 0;

bus_dmamap_sync(sc->sc_dmat, ring->desc_dma.map,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
desc_dma.map), ((char *)(void *)desc - (char *)(void *)ring->
desc_dma.vaddr), (sizeof(*desc)), (0x04))
   (char *)(void *)desc - (char *)(void *)ring->desc_dma.vaddr,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
desc_dma.map), ((char *)(void *)desc - (char *)(void *)ring->
desc_dma.vaddr), (sizeof(*desc)), (0x04))
   sizeof(*desc), BUS_DMASYNC_PREWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
desc_dma.map), ((char *)(void *)desc - (char *)(void *)ring->
desc_dma.vaddr), (sizeof(*desc)), (0x04));
4560}

4562void
4563iwx_txd_done(struct iwx_softc *sc, struct iwx_tx_data *txd)
4564{
struct ieee80211com *ic = &sc->sc_ic;

bus_dmamap_sync(sc->sc_dmat, txd->map, 0, txd->map->dm_mapsize,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (txd->
map), (0), (txd->map->dm_mapsize), (0x08))
   BUS_DMASYNC_POSTWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (txd->
map), (0), (txd->map->dm_mapsize), (0x08));
bus_dmamap_unload(sc->sc_dmat, txd->map)(*(sc->sc_dmat)->_dmamap_unload)((sc->sc_dmat), (txd
->map));
m_freem(txd->m);
txd->m = NULL((void *)0);

KASSERT(txd->in)((txd->in) ? (void)0 : __assert("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c"
, 4573, "txd->in"));
ieee80211_release_node(ic, &txd->in->in_ni);
txd->in = NULL((void *)0);
4576}

4578void
4579iwx_txq_advance(struct iwx_softc *sc, struct iwx_tx_ring *ring, int idx)
4580{
struct iwx_tx_data *txd;

while (ring->tail != idx) {
txd = &ring->data[ring->tail];
if (txd->m != NULL((void *)0)) {
	iwx_clear_tx_desc(sc, ring, ring->tail);
	iwx_tx_update_byte_tbl(ring, ring->tail, 0, 0);
	iwx_txd_done(sc, txd);
	ring->queued--;
}
ring->tail = (ring->tail + 1) % IWX_TX_RING_COUNT(256);
}
4593}

4595void
4596iwx_rx_tx_cmd(struct iwx_softc *sc, struct iwx_rx_packet *pkt,
  struct iwx_rx_data *data)
4598{
struct ieee80211com *ic = &sc->sc_ic;
struct ifnet *ifp = IC2IFP(ic)(&(ic)->ic_ac.ac_if);
struct iwx_cmd_header *cmd_hdr = &pkt->hdr;
int qid = cmd_hdr->qid, status, txfail;
struct iwx_tx_ring *ring = &sc->txq[qid];
struct iwx_tx_resp *tx_resp = (void *)pkt->data;
uint32_t ssn;
uint32_t len = iwx_rx_packet_len(pkt);

bus_dmamap_sync(sc->sc_dmat, data->map, 0, IWX_RBUF_SIZE,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (4096), (0x02))
   BUS_DMASYNC_POSTREAD)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (4096), (0x02));

/* Sanity checks. */
if (sizeof(*tx_resp) > len)
return;
if (qid < IWX_FIRST_AGG_TX_QUEUE(1 + 1) && tx_resp->frame_count > 1)
return;
if (qid >= IWX_FIRST_AGG_TX_QUEUE(1 + 1) && sizeof(*tx_resp) + sizeof(ssn) +
   tx_resp->frame_count * sizeof(tx_resp->status) > len)
return;

sc->sc_tx_timer[qid] = 0;

if (tx_resp->frame_count > 1) /* A-MPDU */
return;

status = le16toh(tx_resp->status.status)((__uint16_t)(tx_resp->status.status)) & IWX_TX_STATUS_MSK0x000000ff;
txfail = (status != IWX_TX_STATUS_SUCCESS0x01 &&
   status != IWX_TX_STATUS_DIRECT_DONE0x02);

if (txfail)
ifp->if_oerrorsif_data.ifi_oerrors++;

/*
* On hardware supported by iwx(4) the SSN counter is only
* 8 bit and corresponds to a Tx ring index rather than a
* sequence number. Frames up to this index (non-inclusive)
* can now be freed.
*/
memcpy(&ssn, &tx_resp->status + tx_resp->frame_count, sizeof(ssn))__builtin_memcpy((&ssn), (&tx_resp->status + tx_resp
->frame_count), (sizeof(ssn)));
ssn = le32toh(ssn)((__uint32_t)(ssn)) & 0xff;
iwx_txq_advance(sc, ring, ssn);
iwx_clear_oactive(sc, ring);
4642}

4644void
4645iwx_clear_oactive(struct iwx_softc *sc, struct iwx_tx_ring *ring)
4646{
struct ieee80211com *ic = &sc->sc_ic;
struct ifnet *ifp = IC2IFP(ic)(&(ic)->ic_ac.ac_if);

if (ring->queued < IWX_TX_RING_LOMARK192) {
sc->qfullmsk &= ~(1 << ring->qid);
if (sc->qfullmsk == 0 && ifq_is_oactive(&ifp->if_snd)) {
	ifq_clr_oactive(&ifp->if_snd);
	/*
	 * Well, we're in interrupt context, but then again
	 * I guess net80211 does all sorts of stunts in
	 * interrupt context, so maybe this is no biggie.
	 */
	(*ifp->if_start)(ifp);
}
}
4662}

4664void
4665iwx_rx_compressed_ba(struct iwx_softc *sc, struct iwx_rx_packet *pkt)
4666{
struct iwx_compressed_ba_notif *ba_res = (void *)pkt->data;
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni;
struct ieee80211_tx_ba *ba;
struct iwx_node *in;
struct iwx_tx_ring *ring;
uint16_t i, tfd_cnt, ra_tid_cnt, idx;
int qid;

if (ic->ic_state != IEEE80211_S_RUN)
return;

if (iwx_rx_packet_payload_len(pkt) < sizeof(*ba_res))
return;

if (ba_res->sta_id != IWX_STATION_ID0)
return;

ni = ic->ic_bss;
in = (void *)ni;

tfd_cnt = le16toh(ba_res->tfd_cnt)((__uint16_t)(ba_res->tfd_cnt));
ra_tid_cnt = le16toh(ba_res->ra_tid_cnt)((__uint16_t)(ba_res->ra_tid_cnt));
if (!tfd_cnt || iwx_rx_packet_payload_len(pkt) < (sizeof(*ba_res) +
   sizeof(ba_res->ra_tid[0]) * ra_tid_cnt +
   sizeof(ba_res->tfd[0]) * tfd_cnt))
return;

for (i = 0; i < tfd_cnt; i++) {
struct iwx_compressed_ba_tfd *ba_tfd = &ba_res->tfd[i];
uint8_t tid;

tid = ba_tfd->tid;
if (tid >= nitems(sc->aggqid)(sizeof((sc->aggqid)) / sizeof((sc->aggqid)[0])))
	continue;

qid = sc->aggqid[tid];
if (qid != htole16(ba_tfd->q_num)((__uint16_t)(ba_tfd->q_num)))
	continue;

ring = &sc->txq[qid];

ba = &ni->ni_tx_ba[tid];
if (ba->ba_state != IEEE80211_BA_AGREED2)
	continue;

idx = le16toh(ba_tfd->tfd_index)((__uint16_t)(ba_tfd->tfd_index));
if (idx >= IWX_TX_RING_COUNT(256))
	continue;
sc->sc_tx_timer[qid] = 0;
iwx_txq_advance(sc, ring, idx);
iwx_clear_oactive(sc, ring);
}
4720}

4722void
4723iwx_rx_bmiss(struct iwx_softc *sc, struct iwx_rx_packet *pkt,
  struct iwx_rx_data *data)
4725{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_missed_beacons_notif *mbn = (void *)pkt->data;
uint32_t missed;

if ((ic->ic_opmode != IEEE80211_M_STA) ||
   (ic->ic_state != IEEE80211_S_RUN))
return;

bus_dmamap_sync(sc->sc_dmat, data->map, sizeof(*pkt),(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (sizeof(*pkt)), (sizeof(*mbn)), (0x02))
   sizeof(*mbn), BUS_DMASYNC_POSTREAD)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (sizeof(*pkt)), (sizeof(*mbn)), (0x02));

missed = le32toh(mbn->consec_missed_beacons_since_last_rx)((__uint32_t)(mbn->consec_missed_beacons_since_last_rx));
if (missed > ic->ic_bmissthres && ic->ic_mgt_timer == 0) {
if (ic->ic_ific_ac.ac_if.if_flags & IFF_DEBUG0x4)
	printf("%s: receiving no beacons from %s; checking if "
	    "this AP is still responding to probe requests\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), ether_sprintf(ic->ic_bss->ni_macaddr));
/*
 * Rather than go directly to scan state, try to send a
 * directed probe request first. If that fails then the
 * state machine will drop us into scanning after timing
 * out waiting for a probe response.
 */
IEEE80211_SEND_MGMT(ic, ic->ic_bss,((*(ic)->ic_send_mgmt)(ic, ic->ic_bss, 0x40, 0, 0))
    IEEE80211_FC0_SUBTYPE_PROBE_REQ, 0)((*(ic)->ic_send_mgmt)(ic, ic->ic_bss, 0x40, 0, 0));
}

4753}

4755int
4756iwx_binding_cmd(struct iwx_softc *sc, struct iwx_node *in, uint32_t action)
4757{
struct iwx_binding_cmd cmd;
struct iwx_phy_ctxt *phyctxt = in->in_phyctxt;
uint32_t mac_id = IWX_FW_CMD_ID_AND_COLOR(in->in_id, in->in_color)((in->in_id << (0)) | (in->in_color << (8))
);
int i, err, active = (sc->sc_flags & IWX_FLAG_BINDING_ACTIVE0x10);
uint32_t status;

if (action == IWX_FW_CTXT_ACTION_ADD1 && active)
panic("binding already added");
if (action == IWX_FW_CTXT_ACTION_REMOVE3 && !active)
panic("binding already removed");

if (phyctxt == NULL((void *)0)) /* XXX race with iwx_stop() */
return EINVAL22;

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));

cmd.id_and_color
   = htole32(IWX_FW_CMD_ID_AND_COLOR(phyctxt->id, phyctxt->color))((__uint32_t)(((phyctxt->id << (0)) | (phyctxt->color
 << (8)))));
cmd.action = htole32(action)((__uint32_t)(action));
cmd.phy = htole32(IWX_FW_CMD_ID_AND_COLOR(phyctxt->id, phyctxt->color))((__uint32_t)(((phyctxt->id << (0)) | (phyctxt->color
 << (8)))));

cmd.macs[0] = htole32(mac_id)((__uint32_t)(mac_id));
for (i = 1; i < IWX_MAX_MACS_IN_BINDING(3); i++)
cmd.macs[i] = htole32(IWX_FW_CTXT_INVALID)((__uint32_t)((0xffffffff)));

if (IEEE80211_IS_CHAN_2GHZ(phyctxt->channel)(((phyctxt->channel)->ic_flags & 0x0080) != 0) ||
   !isset(sc->sc_enabled_capa, IWX_UCODE_TLV_CAPA_CDB_SUPPORT)((sc->sc_enabled_capa)[(40)>>3] & (1<<((40
)&(8 -1)))))
cmd.lmac_id = htole32(IWX_LMAC_24G_INDEX)((__uint32_t)(0));
else
cmd.lmac_id = htole32(IWX_LMAC_5G_INDEX)((__uint32_t)(1));

status = 0;
err = iwx_send_cmd_pdu_status(sc, IWX_BINDING_CONTEXT_CMD0x2b, sizeof(cmd),
   &cmd, &status);
if (err == 0 && status != 0)
err = EIO5;

return err;
4796}

4798int
4799iwx_phy_ctxt_cmd_uhb_v3(struct iwx_softc *sc, struct iwx_phy_ctxt *ctxt,
  uint8_t chains_static, uint8_t chains_dynamic, uint32_t action, uint8_t sco)
4801{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_phy_context_cmd_uhb cmd;
uint8_t active_cnt, idle_cnt;
struct ieee80211_channel *chan = ctxt->channel;

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));
cmd.id_and_color = htole32(IWX_FW_CMD_ID_AND_COLOR(ctxt->id,((__uint32_t)(((ctxt->id << (0)) | (ctxt->color <<
 (8)))))
   ctxt->color))((__uint32_t)(((ctxt->id << (0)) | (ctxt->color <<
 (8)))));
cmd.action = htole32(action)((__uint32_t)(action));

if (IEEE80211_IS_CHAN_2GHZ(ctxt->channel)(((ctxt->channel)->ic_flags & 0x0080) != 0) ||
   !isset(sc->sc_enabled_capa, IWX_UCODE_TLV_CAPA_CDB_SUPPORT)((sc->sc_enabled_capa)[(40)>>3] & (1<<((40
)&(8 -1)))))
cmd.lmac_id = htole32(IWX_LMAC_24G_INDEX)((__uint32_t)(0));
else
cmd.lmac_id = htole32(IWX_LMAC_5G_INDEX)((__uint32_t)(1));

cmd.ci.band = IEEE80211_IS_CHAN_2GHZ(chan)(((chan)->ic_flags & 0x0080) != 0) ?
   IWX_PHY_BAND_24(1) : IWX_PHY_BAND_5(0);
cmd.ci.channel = htole32(ieee80211_chan2ieee(ic, chan))((__uint32_t)(ieee80211_chan2ieee(ic, chan)));
if (chan->ic_flags & IEEE80211_CHAN_40MHZ0x8000) {
if (sco == IEEE80211_HTOP0_SCO_SCA1) {
	/* secondary chan above -> control chan below */
	cmd.ci.ctrl_pos = IWX_PHY_VHT_CTRL_POS_1_BELOW(0x0);
	cmd.ci.width = IWX_PHY_VHT_CHANNEL_MODE40(0x1);
} else if (sco == IEEE80211_HTOP0_SCO_SCB3) {
	/* secondary chan below -> control chan above */
	cmd.ci.ctrl_pos = IWX_PHY_VHT_CTRL_POS_1_ABOVE(0x4);
	cmd.ci.width = IWX_PHY_VHT_CHANNEL_MODE40(0x1);
} else {
	cmd.ci.width = IWX_PHY_VHT_CHANNEL_MODE20(0x0);
	cmd.ci.ctrl_pos = IWX_PHY_VHT_CTRL_POS_1_BELOW(0x0);
}
} else {
cmd.ci.width = IWX_PHY_VHT_CHANNEL_MODE20(0x0);
cmd.ci.ctrl_pos = IWX_PHY_VHT_CTRL_POS_1_BELOW(0x0);
}

idle_cnt = chains_static;
active_cnt = chains_dynamic;
cmd.rxchain_info = htole32(iwx_fw_valid_rx_ant(sc) <<((__uint32_t)(iwx_fw_valid_rx_ant(sc) << (1)))
   IWX_PHY_RX_CHAIN_VALID_POS)((__uint32_t)(iwx_fw_valid_rx_ant(sc) << (1)));
cmd.rxchain_info |= htole32(idle_cnt << IWX_PHY_RX_CHAIN_CNT_POS)((__uint32_t)(idle_cnt << (10)));
cmd.rxchain_info |= htole32(active_cnt <<((__uint32_t)(active_cnt << (12)))
   IWX_PHY_RX_CHAIN_MIMO_CNT_POS)((__uint32_t)(active_cnt << (12)));

return iwx_send_cmd_pdu(sc, IWX_PHY_CONTEXT_CMD0x8, 0, sizeof(cmd), &cmd);
4848}

4850int
4851iwx_phy_ctxt_cmd_v3(struct iwx_softc *sc, struct iwx_phy_ctxt *ctxt,
  uint8_t chains_static, uint8_t chains_dynamic, uint32_t action, uint8_t sco)
4853{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_phy_context_cmd cmd;
uint8_t active_cnt, idle_cnt;
struct ieee80211_channel *chan = ctxt->channel;

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));
cmd.id_and_color = htole32(IWX_FW_CMD_ID_AND_COLOR(ctxt->id,((__uint32_t)(((ctxt->id << (0)) | (ctxt->color <<
 (8)))))
   ctxt->color))((__uint32_t)(((ctxt->id << (0)) | (ctxt->color <<
 (8)))));
cmd.action = htole32(action)((__uint32_t)(action));

if (IEEE80211_IS_CHAN_2GHZ(ctxt->channel)(((ctxt->channel)->ic_flags & 0x0080) != 0) ||
   !isset(sc->sc_enabled_capa, IWX_UCODE_TLV_CAPA_CDB_SUPPORT)((sc->sc_enabled_capa)[(40)>>3] & (1<<((40
)&(8 -1)))))
cmd.lmac_id = htole32(IWX_LMAC_24G_INDEX)((__uint32_t)(0));
else
cmd.lmac_id = htole32(IWX_LMAC_5G_INDEX)((__uint32_t)(1));

cmd.ci.band = IEEE80211_IS_CHAN_2GHZ(chan)(((chan)->ic_flags & 0x0080) != 0) ?
   IWX_PHY_BAND_24(1) : IWX_PHY_BAND_5(0);
cmd.ci.channel = ieee80211_chan2ieee(ic, chan);
if (chan->ic_flags & IEEE80211_CHAN_40MHZ0x8000) {
if (sco == IEEE80211_HTOP0_SCO_SCA1) {
	/* secondary chan above -> control chan below */
	cmd.ci.ctrl_pos = IWX_PHY_VHT_CTRL_POS_1_BELOW(0x0);
	cmd.ci.width = IWX_PHY_VHT_CHANNEL_MODE40(0x1);
} else if (sco == IEEE80211_HTOP0_SCO_SCB3) {
	/* secondary chan below -> control chan above */
	cmd.ci.ctrl_pos = IWX_PHY_VHT_CTRL_POS_1_ABOVE(0x4);
	cmd.ci.width = IWX_PHY_VHT_CHANNEL_MODE40(0x1);
} else {
	cmd.ci.width = IWX_PHY_VHT_CHANNEL_MODE20(0x0);
	cmd.ci.ctrl_pos = IWX_PHY_VHT_CTRL_POS_1_BELOW(0x0);
}
} else {
cmd.ci.width = IWX_PHY_VHT_CHANNEL_MODE20(0x0);
cmd.ci.ctrl_pos = IWX_PHY_VHT_CTRL_POS_1_BELOW(0x0);
}

idle_cnt = chains_static;
active_cnt = chains_dynamic;
cmd.rxchain_info = htole32(iwx_fw_valid_rx_ant(sc) <<((__uint32_t)(iwx_fw_valid_rx_ant(sc) << (1)))
   IWX_PHY_RX_CHAIN_VALID_POS)((__uint32_t)(iwx_fw_valid_rx_ant(sc) << (1)));
cmd.rxchain_info |= htole32(idle_cnt << IWX_PHY_RX_CHAIN_CNT_POS)((__uint32_t)(idle_cnt << (10)));
cmd.rxchain_info |= htole32(active_cnt <<((__uint32_t)(active_cnt << (12)))
   IWX_PHY_RX_CHAIN_MIMO_CNT_POS)((__uint32_t)(active_cnt << (12)));

return iwx_send_cmd_pdu(sc, IWX_PHY_CONTEXT_CMD0x8, 0, sizeof(cmd), &cmd);
4900}

4902int
4903iwx_phy_ctxt_cmd(struct iwx_softc *sc, struct iwx_phy_ctxt *ctxt,
  uint8_t chains_static, uint8_t chains_dynamic, uint32_t action,
  uint32_t apply_time, uint8_t sco)
4906{
int cmdver;

cmdver = iwx_lookup_cmd_ver(sc, IWX_LONG_GROUP0x1, IWX_PHY_CONTEXT_CMD0x8);
if (cmdver != 3) {
printf("%s: firmware does not support phy-context-cmd v3\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
return ENOTSUP91;
}

/*
* Intel increased the size of the fw_channel_info struct and neglected
* to bump the phy_context_cmd struct, which contains an fw_channel_info
* member in the middle.
* To keep things simple we use a separate function to handle the larger
* variant of the phy context command.
*/
if (isset(sc->sc_enabled_capa, IWX_UCODE_TLV_CAPA_ULTRA_HB_CHANNELS)((sc->sc_enabled_capa)[(48)>>3] & (1<<((48
)&(8 -1))))) {
return iwx_phy_ctxt_cmd_uhb_v3(sc, ctxt, chains_static,
    chains_dynamic, action, sco);
}

return iwx_phy_ctxt_cmd_v3(sc, ctxt, chains_static, chains_dynamic,
   action, sco);
4930}

4932int
4933iwx_send_cmd(struct iwx_softc *sc, struct iwx_host_cmd *hcmd)
4934{
struct iwx_tx_ring *ring = &sc->txq[IWX_DQA_CMD_QUEUE0];
struct iwx_tfh_tfd *desc;
struct iwx_tx_data *txdata;
struct iwx_device_cmd *cmd;
struct mbuf *m;
bus_addr_t paddr;
uint64_t addr;
int err = 0, i, paylen, off, s;
int idx, code, async, group_id;
size_t hdrlen, datasz;
uint8_t *data;
int generation = sc->sc_generation;

code = hcmd->id;
async = hcmd->flags & IWX_CMD_ASYNC;
idx = ring->cur;

for (i = 0, paylen = 0; i < nitems(hcmd->len)(sizeof((hcmd->len)) / sizeof((hcmd->len)[0])); i++) {
paylen += hcmd->len[i];
}

/* If this command waits for a response, allocate response buffer. */
hcmd->resp_pkt = NULL((void *)0);
if (hcmd->flags & IWX_CMD_WANT_RESP) {
uint8_t *resp_buf;
KASSERT(!async)((!async) ? (void)0 : __assert("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c"
, 4960, "!async"));
KASSERT(hcmd->resp_pkt_len >= sizeof(struct iwx_rx_packet))((hcmd->resp_pkt_len >= sizeof(struct iwx_rx_packet)) ?
 (void)0 : __assert("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c"
, 4961, "hcmd->resp_pkt_len >= sizeof(struct iwx_rx_packet)"
));
KASSERT(hcmd->resp_pkt_len <= IWX_CMD_RESP_MAX)((hcmd->resp_pkt_len <= (1 << 12)) ? (void)0 : __assert
("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c", 4962, "hcmd->resp_pkt_len <= IWX_CMD_RESP_MAX"
));
if (sc->sc_cmd_resp_pkt[idx] != NULL((void *)0))
	return ENOSPC28;
resp_buf = malloc(hcmd->resp_pkt_len, M_DEVBUF2,
    M_NOWAIT0x0002 | M_ZERO0x0008);
if (resp_buf == NULL((void *)0))
	return ENOMEM12;
sc->sc_cmd_resp_pkt[idx] = resp_buf;
sc->sc_cmd_resp_len[idx] = hcmd->resp_pkt_len;
} else {
sc->sc_cmd_resp_pkt[idx] = NULL((void *)0);
}

s = splnet()splraise(0x7);

desc = &ring->desc[idx];
txdata = &ring->data[idx];

/*
* XXX Intel inside (tm)
* Firmware API versions >= 50 reject old-style commands in
* group 0 with a "BAD_COMMAND" firmware error. We must pretend
* that such commands were in the LONG_GROUP instead in order
* for firmware to accept them.
*/
if (iwx_cmd_groupid(code) == 0) {
code = IWX_WIDE_ID(IWX_LONG_GROUP, code)((0x1 << 8) | code);
txdata->flags |= IWX_TXDATA_FLAG_CMD_IS_NARROW0x01;
} else
txdata->flags &= ~IWX_TXDATA_FLAG_CMD_IS_NARROW0x01;

group_id = iwx_cmd_groupid(code);

hdrlen = sizeof(cmd->hdr_wide);
datasz = sizeof(cmd->data_wide);

if (paylen > datasz) {
/* Command is too large to fit in pre-allocated space. */
size_t totlen = hdrlen + paylen;
if (paylen > IWX_MAX_CMD_PAYLOAD_SIZE(4096 - sizeof(struct iwx_cmd_header_wide))) {
	printf("%s: firmware command too long (%zd bytes)\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), totlen);
	err = EINVAL22;
	goto out;
}
m = MCLGETL(NULL, M_DONTWAIT, totlen)m_clget((((void *)0)), (0x0002), (totlen));
if (m == NULL((void *)0)) {
	printf("%s: could not get fw cmd mbuf (%zd bytes)\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), totlen);
	err = ENOMEM12;
	goto out;
}
cmd = mtod(m, struct iwx_device_cmd *)((struct iwx_device_cmd *)((m)->m_hdr.mh_data));
err = bus_dmamap_load(sc->sc_dmat, txdata->map, cmd,(*(sc->sc_dmat)->_dmamap_load)((sc->sc_dmat), (txdata
->map), (cmd), (totlen), (((void *)0)), (0x0001 | 0x0400))
    totlen, NULL, BUS_DMA_NOWAIT | BUS_DMA_WRITE)(*(sc->sc_dmat)->_dmamap_load)((sc->sc_dmat), (txdata
->map), (cmd), (totlen), (((void *)0)), (0x0001 | 0x0400));
if (err) {
	printf("%s: could not load fw cmd mbuf (%zd bytes)\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), totlen);
	m_freem(m);
	goto out;
}
txdata->m = m; /* mbuf will be freed in iwx_cmd_done() */
paddr = txdata->map->dm_segs[0].ds_addr;
} else {
cmd = &ring->cmd[idx];
paddr = txdata->cmd_paddr;
}

memset(cmd, 0, sizeof(*cmd))__builtin_memset((cmd), (0), (sizeof(*cmd)));
cmd->hdr_wide.opcode = iwx_cmd_opcode(code);
cmd->hdr_wide.group_id = group_id;
cmd->hdr_wide.qid = ring->qid;
cmd->hdr_wide.idx = idx;
cmd->hdr_wide.length = htole16(paylen)((__uint16_t)(paylen));
cmd->hdr_wide.version = iwx_cmd_version(code);
data = cmd->data_wide;

for (i = 0, off = 0; i < nitems(hcmd->data)(sizeof((hcmd->data)) / sizeof((hcmd->data)[0])); i++) {
if (hcmd->len[i] == 0)
	continue;
memcpy(data + off, hcmd->data[i], hcmd->len[i])__builtin_memcpy((data + off), (hcmd->data[i]), (hcmd->
len[i]));
off += hcmd->len[i];
}
KASSERT(off == paylen)((off == paylen) ? (void)0 : __assert("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c"
, 5045, "off == paylen"));

desc->tbs[0].tb_len = htole16(MIN(hdrlen + paylen, IWX_FIRST_TB_SIZE))((__uint16_t)((((hdrlen + paylen)<(20))?(hdrlen + paylen):
(20))));
addr = htole64(paddr)((__uint64_t)(paddr));
memcpy(&desc->tbs[0].addr, &addr, sizeof(addr))__builtin_memcpy((&desc->tbs[0].addr), (&addr), (sizeof
(addr)));
if (hdrlen + paylen > IWX_FIRST_TB_SIZE20) {
desc->tbs[1].tb_len = htole16(hdrlen + paylen -((__uint16_t)(hdrlen + paylen - 20))
    IWX_FIRST_TB_SIZE)((__uint16_t)(hdrlen + paylen - 20));
addr = htole64(paddr + IWX_FIRST_TB_SIZE)((__uint64_t)(paddr + 20));
memcpy(&desc->tbs[1].addr, &addr, sizeof(addr))__builtin_memcpy((&desc->tbs[1].addr), (&addr), (sizeof
(addr)));
desc->num_tbs = htole16(2)((__uint16_t)(2));
} else
desc->num_tbs = htole16(1)((__uint16_t)(1));

if (paylen > datasz) {
bus_dmamap_sync(sc->sc_dmat, txdata->map, 0,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (txdata
->map), (0), (hdrlen + paylen), (0x04))
    hdrlen + paylen, BUS_DMASYNC_PREWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (txdata
->map), (0), (hdrlen + paylen), (0x04));
} else {
bus_dmamap_sync(sc->sc_dmat, ring->cmd_dma.map,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
cmd_dma.map), ((char *)(void *)cmd - (char *)(void *)ring->
cmd_dma.vaddr), (hdrlen + paylen), (0x04))
    (char *)(void *)cmd - (char *)(void *)ring->cmd_dma.vaddr,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
cmd_dma.map), ((char *)(void *)cmd - (char *)(void *)ring->
cmd_dma.vaddr), (hdrlen + paylen), (0x04))
    hdrlen + paylen, BUS_DMASYNC_PREWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
cmd_dma.map), ((char *)(void *)cmd - (char *)(void *)ring->
cmd_dma.vaddr), (hdrlen + paylen), (0x04));
}
bus_dmamap_sync(sc->sc_dmat, ring->desc_dma.map,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
desc_dma.map), ((char *)(void *)desc - (char *)(void *)ring->
desc_dma.vaddr), (sizeof (*desc)), (0x04))
   (char *)(void *)desc - (char *)(void *)ring->desc_dma.vaddr,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
desc_dma.map), ((char *)(void *)desc - (char *)(void *)ring->
desc_dma.vaddr), (sizeof (*desc)), (0x04))
   sizeof (*desc), BUS_DMASYNC_PREWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
desc_dma.map), ((char *)(void *)desc - (char *)(void *)ring->
desc_dma.vaddr), (sizeof (*desc)), (0x04));
/* Kick command ring. */
DPRINTF(("%s: sending command 0x%x\n", __func__, code))do { ; } while (0);
ring->queued++;
ring->cur = (ring->cur + 1) % IWX_TX_RING_COUNT(256);
IWX_WRITE(sc, IWX_HBUS_TARG_WRPTR, ring->qid << 16 | ring->cur)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x400)+0x060
))), ((ring->qid << 16 | ring->cur))));

if (!async) {
err = tsleep_nsec(desc, PCATCH0x100, "iwxcmd", SEC_TO_NSEC(1));
if (err == 0) {
	/* if hardware is no longer up, return error */
	if (generation != sc->sc_generation) {
		err = ENXIO6;
		goto out;
	}

	/* Response buffer will be freed in iwx_free_resp(). */
	hcmd->resp_pkt = (void *)sc->sc_cmd_resp_pkt[idx];
	sc->sc_cmd_resp_pkt[idx] = NULL((void *)0);
} else if (generation == sc->sc_generation) {
	free(sc->sc_cmd_resp_pkt[idx], M_DEVBUF2,
	    sc->sc_cmd_resp_len[idx]);
	sc->sc_cmd_resp_pkt[idx] = NULL((void *)0);	
}
}
out:
splx(s)spllower(s);

return err;
5098}

5100int
5101iwx_send_cmd_pdu(struct iwx_softc *sc, uint32_t id, uint32_t flags,
  uint16_t len, const void *data)
5103{
struct iwx_host_cmd cmd = {
.id = id,
.len = { len, },
.data = { data, },
.flags = flags,
};

return iwx_send_cmd(sc, &cmd);
5112}

5114int
5115iwx_send_cmd_status(struct iwx_softc *sc, struct iwx_host_cmd *cmd,
  uint32_t *status)
5117{
struct iwx_rx_packet *pkt;
struct iwx_cmd_response *resp;
int err, resp_len;

KASSERT((cmd->flags & IWX_CMD_WANT_RESP) == 0)(((cmd->flags & IWX_CMD_WANT_RESP) == 0) ? (void)0 : __assert
("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c", 5122, "(cmd->flags & IWX_CMD_WANT_RESP) == 0"
));
cmd->flags |= IWX_CMD_WANT_RESP;
cmd->resp_pkt_len = sizeof(*pkt) + sizeof(*resp);

err = iwx_send_cmd(sc, cmd);
if (err)
return err;

pkt = cmd->resp_pkt;
if (pkt == NULL((void *)0) || (pkt->hdr.flags & IWX_CMD_FAILED_MSK0x40))
return EIO5;

resp_len = iwx_rx_packet_payload_len(pkt);
if (resp_len != sizeof(*resp)) {
iwx_free_resp(sc, cmd);
return EIO5;
}

resp = (void *)pkt->data;
*status = le32toh(resp->status)((__uint32_t)(resp->status));
iwx_free_resp(sc, cmd);
return err;
5144}

5146int
5147iwx_send_cmd_pdu_status(struct iwx_softc *sc, uint32_t id, uint16_t len,
  const void *data, uint32_t *status)
5149{
struct iwx_host_cmd cmd = {
.id = id,
.len = { len, },
.data = { data, },
};

return iwx_send_cmd_status(sc, &cmd, status);
5157}

5159void
5160iwx_free_resp(struct iwx_softc *sc, struct iwx_host_cmd *hcmd)
5161{
KASSERT((hcmd->flags & (IWX_CMD_WANT_RESP)) == IWX_CMD_WANT_RESP)(((hcmd->flags & (IWX_CMD_WANT_RESP)) == IWX_CMD_WANT_RESP
) ? (void)0 : __assert("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c"
, 5162, "(hcmd->flags & (IWX_CMD_WANT_RESP)) == IWX_CMD_WANT_RESP"
));
free(hcmd->resp_pkt, M_DEVBUF2, hcmd->resp_pkt_len);
hcmd->resp_pkt = NULL((void *)0);
5165}

5167void
5168iwx_cmd_done(struct iwx_softc *sc, int qid, int idx, int code)
5169{
struct iwx_tx_ring *ring = &sc->txq[IWX_DQA_CMD_QUEUE0];
struct iwx_tx_data *data;

if (qid != IWX_DQA_CMD_QUEUE0) {
return;	/* Not a command ack. */
}

data = &ring->data[idx];

if (data->m != NULL((void *)0)) {
bus_dmamap_sync(sc->sc_dmat, data->map, 0,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (data->map->dm_mapsize), (0x08))
    data->map->dm_mapsize, BUS_DMASYNC_POSTWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (data->map->dm_mapsize), (0x08));
bus_dmamap_unload(sc->sc_dmat, data->map)(*(sc->sc_dmat)->_dmamap_unload)((sc->sc_dmat), (data
->map));
m_freem(data->m);
data->m = NULL((void *)0);
}
wakeup(&ring->desc[idx]);

DPRINTF(("%s: command 0x%x done\n", __func__, code))do { ; } while (0);
if (ring->queued == 0) {
DPRINTF(("%s: unexpected firmware response to command 0x%x\n",do { ; } while (0)
	DEVNAME(sc), code))do { ; } while (0);
} else if (ring->queued > 0)
ring->queued--;
5194}

5196/*
* Fill in various bit for management frames, and leave them
* unfilled for data frames (firmware takes care of that).
* Return the selected TX rate.
*/
5201const struct iwx_rate *
5202iwx_tx_fill_cmd(struct iwx_softc *sc, struct iwx_node *in,
  struct ieee80211_frame *wh, struct iwx_tx_cmd_gen2 *tx)
5204{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni = &in->in_ni;
struct ieee80211_rateset *rs = &ni->ni_rates;
const struct iwx_rate *rinfo;
int type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK0x0c;
int min_ridx = iwx_rval2ridx(ieee80211_min_basic_rate(ic));
int ridx, rate_flags;
uint32_t flags = 0;

if (IEEE80211_IS_MULTICAST(wh->i_addr1)(*(wh->i_addr1) & 0x01) ||
   type != IEEE80211_FC0_TYPE_DATA0x08) {
/* for non-data, use the lowest supported rate */
ridx = min_ridx;
flags |= IWX_TX_FLAGS_CMD_RATE(1 << 0);
} else if (ic->ic_fixed_mcs != -1) {
ridx = sc->sc_fixed_ridx;
flags |= IWX_TX_FLAGS_CMD_RATE(1 << 0);
} else if (ic->ic_fixed_rate != -1) {
ridx = sc->sc_fixed_ridx;
flags |= IWX_TX_FLAGS_CMD_RATE(1 << 0);
} else if (ni->ni_flags & IEEE80211_NODE_HT0x0400) {
ridx = iwx_mcs2ridx[ni->ni_txmcs];
} else {
uint8_t rval;
rval = (rs->rs_rates[ni->ni_txrate] & IEEE80211_RATE_VAL0x7f);
ridx = iwx_rval2ridx(rval);
if (ridx < min_ridx)
	ridx = min_ridx;
}

if ((ic->ic_flags & IEEE80211_F_RSNON0x00200000) &&
   ni->ni_rsn_supp_state == RSNA_SUPP_PTKNEGOTIATING)
flags |= IWX_TX_FLAGS_HIGH_PRI(1 << 2);
tx->flags = htole32(flags)((__uint32_t)(flags));

rinfo = &iwx_rates[ridx];
if (iwx_is_mimo_ht_plcp(rinfo->ht_plcp))
rate_flags = IWX_RATE_MCS_ANT_AB_MSK((1 << 14) | (2 << 14));
else
rate_flags = IWX_RATE_MCS_ANT_A_MSK(1 << 14);
if (IWX_RIDX_IS_CCK(ridx)((ridx) < 4))
rate_flags |= IWX_RATE_MCS_CCK_MSK(1 << 9);
if ((ni->ni_flags & IEEE80211_NODE_HT0x0400) &&
    type == IEEE80211_FC0_TYPE_DATA0x08 &&
   rinfo->ht_plcp != IWX_RATE_HT_SISO_MCS_INV_PLCP0x20) {
uint8_t sco;
if (ieee80211_node_supports_ht_chan40(ni))
	sco = (ni->ni_htop0 & IEEE80211_HTOP0_SCO_MASK0x03);
else
	sco = IEEE80211_HTOP0_SCO_SCN0;
rate_flags |= IWX_RATE_MCS_HT_MSK(1 << 8); 
if ((sco == IEEE80211_HTOP0_SCO_SCA1 || 
    sco == IEEE80211_HTOP0_SCO_SCB3) &&
    in->in_phyctxt != NULL((void *)0) && in->in_phyctxt->sco == sco) {
	rate_flags |= IWX_RATE_MCS_CHAN_WIDTH_40(1 << 11);
	if (ieee80211_node_supports_ht_sgi40(ni))
		rate_flags |= IWX_RATE_MCS_SGI_MSK(1 << 13);
} else if (ieee80211_node_supports_ht_sgi20(ni))
	rate_flags |= IWX_RATE_MCS_SGI_MSK(1 << 13);
tx->rate_n_flags = htole32(rate_flags | rinfo->ht_plcp)((__uint32_t)(rate_flags | rinfo->ht_plcp));
} else
tx->rate_n_flags = htole32(rate_flags | rinfo->plcp)((__uint32_t)(rate_flags | rinfo->plcp));

return rinfo;
5269}

5271void
5272iwx_tx_update_byte_tbl(struct iwx_tx_ring *txq, int idx, uint16_t byte_cnt,
  uint16_t num_tbs)
5274{
uint8_t filled_tfd_size, num_fetch_chunks;
uint16_t len = byte_cnt;
uint16_t bc_ent;
struct iwx_agn_scd_bc_tbl *scd_bc_tbl = txq->bc_tbl.vaddr;

filled_tfd_size = offsetof(struct iwx_tfh_tfd, tbs)__builtin_offsetof(struct iwx_tfh_tfd, tbs) +
	  num_tbs * sizeof(struct iwx_tfh_tb);
/*
* filled_tfd_size contains the number of filled bytes in the TFD.
* Dividing it by 64 will give the number of chunks to fetch
* to SRAM- 0 for one chunk, 1 for 2 and so on.
* If, for example, TFD contains only 3 TBs then 32 bytes
* of the TFD are used, and only one chunk of 64 bytes should
* be fetched
*/
num_fetch_chunks = howmany(filled_tfd_size, 64)(((filled_tfd_size) + ((64) - 1)) / (64)) - 1;

/* Before AX210, the HW expects DW */
len = howmany(len, 4)(((len) + ((4) - 1)) / (4));
bc_ent = htole16(len | (num_fetch_chunks << 12))((__uint16_t)(len | (num_fetch_chunks << 12)));
scd_bc_tbl->tfd_offset[idx] = bc_ent;
5296}

5298int
5299iwx_tx(struct iwx_softc *sc, struct mbuf *m, struct ieee80211_node *ni)
5300{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_node *in = (void *)ni;
struct iwx_tx_ring *ring;
struct iwx_tx_data *data;
struct iwx_tfh_tfd *desc;
struct iwx_device_cmd *cmd;
struct iwx_tx_cmd_gen2 *tx;
struct ieee80211_frame *wh;
struct ieee80211_key *k = NULL((void *)0);
const struct iwx_rate *rinfo;
uint64_t paddr;
u_int hdrlen;
bus_dma_segment_t *seg;
uint16_t num_tbs;
uint8_t type, subtype;
int i, totlen, err, pad, qid;

wh = mtod(m, struct ieee80211_frame *)((struct ieee80211_frame *)((m)->m_hdr.mh_data));
type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK0x0c;
subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK0xf0;
if (type == IEEE80211_FC0_TYPE_CTL0x04)
hdrlen = sizeof(struct ieee80211_frame_min);
else
hdrlen = ieee80211_get_hdrlen(wh);

qid = sc->first_data_qid;

/* Put QoS frames on the data queue which maps to their TID. */
if (ieee80211_has_qos(wh)) {
struct ieee80211_tx_ba *ba;
uint16_t qos = ieee80211_get_qos(wh);
uint8_t tid = qos & IEEE80211_QOS_TID0x000f;

ba = &ni->ni_tx_ba[tid];
if (!IEEE80211_IS_MULTICAST(wh->i_addr1)(*(wh->i_addr1) & 0x01) &&
    type == IEEE80211_FC0_TYPE_DATA0x08 &&
    subtype != IEEE80211_FC0_SUBTYPE_NODATA0x40 &&
    sc->aggqid[tid] != 0 &&
    ba->ba_state == IEEE80211_BA_AGREED2) {
	qid = sc->aggqid[tid];
}
}

ring = &sc->txq[qid];
desc = &ring->desc[ring->cur];
memset(desc, 0, sizeof(*desc))__builtin_memset((desc), (0), (sizeof(*desc)));
data = &ring->data[ring->cur];

cmd = &ring->cmd[ring->cur];
cmd->hdr.code = IWX_TX_CMD0x1c;
cmd->hdr.flags = 0;
cmd->hdr.qid = ring->qid;
cmd->hdr.idx = ring->cur;

tx = (void *)cmd->data;
memset(tx, 0, sizeof(*tx))__builtin_memset((tx), (0), (sizeof(*tx)));

rinfo = iwx_tx_fill_cmd(sc, in, wh, tx);

5360#if NBPFILTER1 > 0
if (sc->sc_drvbpf != NULL((void *)0)) {
struct iwx_tx_radiotap_header *tap = &sc->sc_txtapsc_txtapu.th;
uint16_t chan_flags;

tap->wt_flags = 0;
tap->wt_chan_freq = htole16(ni->ni_chan->ic_freq)((__uint16_t)(ni->ni_chan->ic_freq));
chan_flags = ni->ni_chan->ic_flags;
if (ic->ic_curmode != IEEE80211_MODE_11N)
	chan_flags &= ~IEEE80211_CHAN_HT0x2000;
tap->wt_chan_flags = htole16(chan_flags)((__uint16_t)(chan_flags));
if ((ni->ni_flags & IEEE80211_NODE_HT0x0400) &&
    !IEEE80211_IS_MULTICAST(wh->i_addr1)(*(wh->i_addr1) & 0x01) &&
    type == IEEE80211_FC0_TYPE_DATA0x08 &&
    rinfo->ht_plcp != IWX_RATE_HT_SISO_MCS_INV_PLCP0x20) {
	tap->wt_rate = (0x80 | rinfo->ht_plcp);
} else
	tap->wt_rate = rinfo->rate;
if ((ic->ic_flags & IEEE80211_F_WEPON0x00000100) &&
    (wh->i_fc[1] & IEEE80211_FC1_PROTECTED0x40))
	tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP0x04;

bpf_mtap_hdr(sc->sc_drvbpf, tap, sc->sc_txtap_len,
    m, BPF_DIRECTION_OUT(1 << 1));
}
5385#endif

if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED0x40) {
              k = ieee80211_get_txkey(ic, wh, ni);
if (k->k_cipher != IEEE80211_CIPHER_CCMP) {
	if ((m = ieee80211_encrypt(ic, m, k)) == NULL((void *)0))
		return ENOBUFS55;
	/* 802.11 header may have moved. */
	wh = mtod(m, struct ieee80211_frame *)((struct ieee80211_frame *)((m)->m_hdr.mh_data));
	tx->flags |= htole32(IWX_TX_FLAGS_ENCRYPT_DIS)((__uint32_t)((1 << 1)));
} else {
	k->k_tsc++;
	/* Hardware increments PN internally and adds IV. */
}
} else
tx->flags |= htole32(IWX_TX_FLAGS_ENCRYPT_DIS)((__uint32_t)((1 << 1)));

totlen = m->m_pkthdrM_dat.MH.MH_pkthdr.len;

if (hdrlen & 3) {
/* First segment length must be a multiple of 4. */
pad = 4 - (hdrlen & 3);
tx->offload_assist |= htole16(IWX_TX_CMD_OFFLD_PAD)((__uint16_t)((1 << 13)));
} else
pad = 0;

tx->len = htole16(totlen)((__uint16_t)(totlen));

/* Copy 802.11 header in TX command. */
memcpy(((uint8_t *)tx) + sizeof(*tx), wh, hdrlen)__builtin_memcpy((((uint8_t *)tx) + sizeof(*tx)), (wh), (hdrlen
));

/* Trim 802.11 header. */
m_adj(m, hdrlen);

err = bus_dmamap_load_mbuf(sc->sc_dmat, data->map, m,(*(sc->sc_dmat)->_dmamap_load_mbuf)((sc->sc_dmat), (
data->map), (m), (0x0001 | 0x0400))
   BUS_DMA_NOWAIT | BUS_DMA_WRITE)(*(sc->sc_dmat)->_dmamap_load_mbuf)((sc->sc_dmat), (
data->map), (m), (0x0001 | 0x0400));
if (err && err != EFBIG27) {
printf("%s: can't map mbuf (error %d)\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
m_freem(m);
return err;
}
if (err) {
/* Too many DMA segments, linearize mbuf. */
if (m_defrag(m, M_DONTWAIT0x0002)) {
	m_freem(m);
	return ENOBUFS55;
}
err = bus_dmamap_load_mbuf(sc->sc_dmat, data->map, m,(*(sc->sc_dmat)->_dmamap_load_mbuf)((sc->sc_dmat), (
data->map), (m), (0x0001 | 0x0400))
    BUS_DMA_NOWAIT | BUS_DMA_WRITE)(*(sc->sc_dmat)->_dmamap_load_mbuf)((sc->sc_dmat), (
data->map), (m), (0x0001 | 0x0400));
if (err) {
	printf("%s: can't map mbuf (error %d)\n", DEVNAME(sc)((sc)->sc_dev.dv_xname),
	    err);
	m_freem(m);
	return err;
}
}
data->m = m;
data->in = in;

/* Fill TX descriptor. */
num_tbs = 2 + data->map->dm_nsegs;
desc->num_tbs = htole16(num_tbs)((__uint16_t)(num_tbs));

desc->tbs[0].tb_len = htole16(IWX_FIRST_TB_SIZE)((__uint16_t)(20));
paddr = htole64(data->cmd_paddr)((__uint64_t)(data->cmd_paddr));
memcpy(&desc->tbs[0].addr, &paddr, sizeof(paddr))__builtin_memcpy((&desc->tbs[0].addr), (&paddr), (
sizeof(paddr)));
if (data->cmd_paddr >> 32 != (data->cmd_paddr + le32toh(desc->tbs[0].tb_len)((__uint32_t)(desc->tbs[0].tb_len))) >> 32)
DPRINTF(("%s: TB0 crosses 32bit boundary\n", __func__))do { ; } while (0);
desc->tbs[1].tb_len = htole16(sizeof(struct iwx_cmd_header) +((__uint16_t)(sizeof(struct iwx_cmd_header) + sizeof(*tx) + hdrlen
 + pad - 20))
   sizeof(*tx) + hdrlen + pad - IWX_FIRST_TB_SIZE)((__uint16_t)(sizeof(struct iwx_cmd_header) + sizeof(*tx) + hdrlen
 + pad - 20));
paddr = htole64(data->cmd_paddr + IWX_FIRST_TB_SIZE)((__uint64_t)(data->cmd_paddr + 20));
memcpy(&desc->tbs[1].addr, &paddr, sizeof(paddr))__builtin_memcpy((&desc->tbs[1].addr), (&paddr), (
sizeof(paddr)));

if (data->cmd_paddr >> 32 != (data->cmd_paddr + le32toh(desc->tbs[1].tb_len)((__uint32_t)(desc->tbs[1].tb_len))) >> 32)
DPRINTF(("%s: TB1 crosses 32bit boundary\n", __func__))do { ; } while (0);

/* Other DMA segments are for data payload. */
seg = data->map->dm_segs;
for (i = 0; i < data->map->dm_nsegs; i++, seg++) {
desc->tbs[i + 2].tb_len = htole16(seg->ds_len)((__uint16_t)(seg->ds_len));
paddr = htole64(seg->ds_addr)((__uint64_t)(seg->ds_addr));
memcpy(&desc->tbs[i + 2].addr, &paddr, sizeof(paddr))__builtin_memcpy((&desc->tbs[i + 2].addr), (&paddr
), (sizeof(paddr)));
if (data->cmd_paddr >> 32 != (data->cmd_paddr + le32toh(desc->tbs[i + 2].tb_len)((__uint32_t)(desc->tbs[i + 2].tb_len))) >> 32)
	DPRINTF(("%s: TB%d crosses 32bit boundary\n", __func__, i + 2))do { ; } while (0);
}

bus_dmamap_sync(sc->sc_dmat, data->map, 0, data->map->dm_mapsize,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (data->map->dm_mapsize), (0x04))
   BUS_DMASYNC_PREWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (data->map->dm_mapsize), (0x04));
bus_dmamap_sync(sc->sc_dmat, ring->cmd_dma.map,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
cmd_dma.map), ((char *)(void *)cmd - (char *)(void *)ring->
cmd_dma.vaddr), (sizeof (*cmd)), (0x04))
   (char *)(void *)cmd - (char *)(void *)ring->cmd_dma.vaddr,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
cmd_dma.map), ((char *)(void *)cmd - (char *)(void *)ring->
cmd_dma.vaddr), (sizeof (*cmd)), (0x04))
   sizeof (*cmd), BUS_DMASYNC_PREWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
cmd_dma.map), ((char *)(void *)cmd - (char *)(void *)ring->
cmd_dma.vaddr), (sizeof (*cmd)), (0x04));
bus_dmamap_sync(sc->sc_dmat, ring->desc_dma.map,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
desc_dma.map), ((char *)(void *)desc - (char *)(void *)ring->
desc_dma.vaddr), (sizeof (*desc)), (0x04))
   (char *)(void *)desc - (char *)(void *)ring->desc_dma.vaddr,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
desc_dma.map), ((char *)(void *)desc - (char *)(void *)ring->
desc_dma.vaddr), (sizeof (*desc)), (0x04))
   sizeof (*desc), BUS_DMASYNC_PREWRITE)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (ring->
desc_dma.map), ((char *)(void *)desc - (char *)(void *)ring->
desc_dma.vaddr), (sizeof (*desc)), (0x04));

iwx_tx_update_byte_tbl(ring, ring->cur, totlen, num_tbs);

/* Kick TX ring. */
ring->cur = (ring->cur + 1) % IWX_TX_RING_COUNT(256);
IWX_WRITE(sc, IWX_HBUS_TARG_WRPTR, ring->qid << 16 | ring->cur)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x400)+0x060
))), ((ring->qid << 16 | ring->cur))));

/* Mark TX ring as full if we reach a certain threshold. */
if (++ring->queued > IWX_TX_RING_HIMARK224) {
sc->qfullmsk |= 1 << ring->qid;
}

if (ic->ic_ific_ac.ac_if.if_flags & IFF_UP0x1)
sc->sc_tx_timer[ring->qid] = 15;

return 0;
5495}

5497int
5498iwx_flush_sta_tids(struct iwx_softc *sc, int sta_id, uint16_t tids)
5499{
struct iwx_rx_packet *pkt;
struct iwx_tx_path_flush_cmd_rsp *resp;
struct iwx_tx_path_flush_cmd flush_cmd = {
.sta_id = htole32(sta_id)((__uint32_t)(sta_id)),
.tid_mask = htole16(tids)((__uint16_t)(tids)),
};
struct iwx_host_cmd hcmd = {
.id = IWX_TXPATH_FLUSH0x1e,
.len = { sizeof(flush_cmd), },
.data = { &flush_cmd, },
.flags = IWX_CMD_WANT_RESP,
.resp_pkt_len = sizeof(*pkt) + sizeof(*resp),
};
int err, resp_len, i, num_flushed_queues;

err = iwx_send_cmd(sc, &hcmd);
if (err)
return err;

pkt = hcmd.resp_pkt;
if (!pkt || (pkt->hdr.flags & IWX_CMD_FAILED_MSK0x40)) {
err = EIO5;
goto out;
}

resp_len = iwx_rx_packet_payload_len(pkt);
/* Some firmware versions don't provide a response. */
if (resp_len == 0)
goto out;
else if (resp_len != sizeof(*resp)) {
err = EIO5;
goto out;
}

resp = (void *)pkt->data;

if (le16toh(resp->sta_id)((__uint16_t)(resp->sta_id)) != sta_id) {
err = EIO5;
goto out;
}

num_flushed_queues = le16toh(resp->num_flushed_queues)((__uint16_t)(resp->num_flushed_queues));
if (num_flushed_queues > IWX_TX_FLUSH_QUEUE_RSP16) {
err = EIO5;
goto out;
}

for (i = 0; i < num_flushed_queues; i++) {
struct iwx_flush_queue_info *queue_info = &resp->queues[i];
uint16_t tid = le16toh(queue_info->tid)((__uint16_t)(queue_info->tid));
uint16_t read_after = le16toh(queue_info->read_after_flush)((__uint16_t)(queue_info->read_after_flush));
uint16_t qid = le16toh(queue_info->queue_num)((__uint16_t)(queue_info->queue_num));
struct iwx_tx_ring *txq;

if (qid >= nitems(sc->txq)(sizeof((sc->txq)) / sizeof((sc->txq)[0])))
	continue;

txq = &sc->txq[qid];
if (tid != txq->tid)
	continue;

iwx_txq_advance(sc, txq, read_after);
}
5563out:
iwx_free_resp(sc, &hcmd);
return err;
5566}

5568#define IWX_FLUSH_WAIT_MS2000	2000

5570int
5571iwx_wait_tx_queues_empty(struct iwx_softc *sc)
5572{
int i, err;

for (i = 0; i < nitems(sc->txq)(sizeof((sc->txq)) / sizeof((sc->txq)[0])); i++) {
struct iwx_tx_ring *ring = &sc->txq[i];

if (i == IWX_DQA_CMD_QUEUE0)
	continue;

while (ring->queued > 0) {
	err = tsleep_nsec(ring, 0, "iwxflush",
	    MSEC_TO_NSEC(IWX_FLUSH_WAIT_MS2000));
	if (err)
		return err;
}
}

return 0;
5590}

5592int
5593iwx_drain_sta(struct iwx_softc *sc, struct iwx_node* in, int drain)
5594{
struct iwx_add_sta_cmd cmd;
int err;
uint32_t status;

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));
cmd.mac_id_n_color = htole32(IWX_FW_CMD_ID_AND_COLOR(in->in_id,((__uint32_t)(((in->in_id << (0)) | (in->in_color
 << (8)))))
   in->in_color))((__uint32_t)(((in->in_id << (0)) | (in->in_color
 << (8)))));
cmd.sta_id = IWX_STATION_ID0;
cmd.add_modify = IWX_STA_MODE_MODIFY1;
cmd.station_flags = drain ? htole32(IWX_STA_FLG_DRAIN_FLOW)((__uint32_t)((1 << 12))) : 0;
cmd.station_flags_msk = htole32(IWX_STA_FLG_DRAIN_FLOW)((__uint32_t)((1 << 12)));

status = IWX_ADD_STA_SUCCESS0x1;
err = iwx_send_cmd_pdu_status(sc, IWX_ADD_STA0x18,
   sizeof(cmd), &cmd, &status);
if (err) {
printf("%s: could not update sta (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
}

switch (status & IWX_ADD_STA_STATUS_MASK0xFF) {
case IWX_ADD_STA_SUCCESS0x1:
break;
default:
err = EIO5;
printf("%s: Couldn't %s draining for station\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), drain ? "enable" : "disable");
break;
}

return err;
5627}

5629int
5630iwx_flush_sta(struct iwx_softc *sc, struct iwx_node *in)
5631{
int err;

splassert(IPL_NET)do { if (splassert_ctl > 0) { splassert_check(0x7, __func__
); } } while (0);

sc->sc_flags |= IWX_FLAG_TXFLUSH0x400;

err = iwx_drain_sta(sc, in, 1);
if (err)
goto done;

err = iwx_flush_sta_tids(sc, IWX_STATION_ID0, 0xffff);
if (err) {
printf("%s: could not flush Tx path (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
goto done;
}

err = iwx_wait_tx_queues_empty(sc);
if (err) {
printf("%s: Could not empty Tx queues (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
goto done;
}

err = iwx_drain_sta(sc, in, 0);
5657done:
sc->sc_flags &= ~IWX_FLAG_TXFLUSH0x400;
return err;
5660}

5662#define IWX_POWER_KEEP_ALIVE_PERIOD_SEC25    25

5664int
5665iwx_beacon_filter_send_cmd(struct iwx_softc *sc,
  struct iwx_beacon_filter_cmd *cmd)
5667{
return iwx_send_cmd_pdu(sc, IWX_REPLY_BEACON_FILTERING_CMD0xd2,
   0, sizeof(struct iwx_beacon_filter_cmd), cmd);
5670}

5672int
5673iwx_update_beacon_abort(struct iwx_softc *sc, struct iwx_node *in, int enable)
5674{
struct iwx_beacon_filter_cmd cmd = {
IWX_BF_CMD_CONFIG_DEFAULTS.bf_energy_delta = ((__uint32_t)(5)), .bf_roaming_energy_delta
 = ((__uint32_t)(1)), .bf_roaming_state = ((__uint32_t)(72)),
 .bf_temp_threshold = ((__uint32_t)(112)), .bf_temp_fast_filter
 = ((__uint32_t)(1)), .bf_temp_slow_filter = ((__uint32_t)(5)
), .bf_debug_flag = ((__uint32_t)(0)), .bf_escape_timer = ((__uint32_t
)(50)), .ba_escape_timer = ((__uint32_t)(6)),
.bf_enable_beacon_filter = htole32(1)((__uint32_t)(1)),
.ba_enable_beacon_abort = htole32(enable)((__uint32_t)(enable)),
};

if (!sc->sc_bf.bf_enabled)
return 0;

sc->sc_bf.ba_enabled = enable;
return iwx_beacon_filter_send_cmd(sc, &cmd);
5686}

5688void
5689iwx_power_build_cmd(struct iwx_softc *sc, struct iwx_node *in,
  struct iwx_mac_power_cmd *cmd)
5691{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni = &in->in_ni;
int dtim_period, dtim_msec, keep_alive;

cmd->id_and_color = htole32(IWX_FW_CMD_ID_AND_COLOR(in->in_id,((__uint32_t)(((in->in_id << (0)) | (in->in_color
 << (8)))))
   in->in_color))((__uint32_t)(((in->in_id << (0)) | (in->in_color
 << (8)))));
if (ni->ni_dtimperiod)
dtim_period = ni->ni_dtimperiod;
else
dtim_period = 1;

/*
* Regardless of power management state the driver must set
* keep alive period. FW will use it for sending keep alive NDPs
* immediately after association. Check that keep alive period
* is at least 3 * DTIM.
*/
dtim_msec = dtim_period * ni->ni_intval;
keep_alive = MAX(3 * dtim_msec, 1000 * IWX_POWER_KEEP_ALIVE_PERIOD_SEC)(((3 * dtim_msec)>(1000 * 25))?(3 * dtim_msec):(1000 * 25)
);
keep_alive = roundup(keep_alive, 1000)((((keep_alive)+((1000)-1))/(1000))*(1000)) / 1000;
cmd->keep_alive_seconds = htole16(keep_alive)((__uint16_t)(keep_alive));

if (ic->ic_opmode != IEEE80211_M_MONITOR)
cmd->flags = htole16(IWX_POWER_FLAGS_POWER_SAVE_ENA_MSK)((__uint16_t)((1 << 0)));
5716}

5718int
5719iwx_power_mac_update_mode(struct iwx_softc *sc, struct iwx_node *in)
5720{
int err;
int ba_enable;
struct iwx_mac_power_cmd cmd;

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));

iwx_power_build_cmd(sc, in, &cmd);

err = iwx_send_cmd_pdu(sc, IWX_MAC_PM_POWER_TABLE0xa9, 0,
   sizeof(cmd), &cmd);
if (err != 0)
return err;

ba_enable = !!(cmd.flags &
   htole16(IWX_POWER_FLAGS_POWER_MANAGEMENT_ENA_MSK)((__uint16_t)((1 << 1))));
return iwx_update_beacon_abort(sc, in, ba_enable);
5737}

5739int
5740iwx_power_update_device(struct iwx_softc *sc)
5741{
struct iwx_device_power_cmd cmd = { };
struct ieee80211com *ic = &sc->sc_ic;

if (ic->ic_opmode != IEEE80211_M_MONITOR)
cmd.flags = htole16(IWX_DEVICE_POWER_FLAGS_POWER_SAVE_ENA_MSK)((__uint16_t)((1 << 0)));

return iwx_send_cmd_pdu(sc,
   IWX_POWER_TABLE_CMD0x77, 0, sizeof(cmd), &cmd);
5750}

5752int
5753iwx_enable_beacon_filter(struct iwx_softc *sc, struct iwx_node *in)
5754{
struct iwx_beacon_filter_cmd cmd = {
IWX_BF_CMD_CONFIG_DEFAULTS.bf_energy_delta = ((__uint32_t)(5)), .bf_roaming_energy_delta
 = ((__uint32_t)(1)), .bf_roaming_state = ((__uint32_t)(72)),
 .bf_temp_threshold = ((__uint32_t)(112)), .bf_temp_fast_filter
 = ((__uint32_t)(1)), .bf_temp_slow_filter = ((__uint32_t)(5)
), .bf_debug_flag = ((__uint32_t)(0)), .bf_escape_timer = ((__uint32_t
)(50)), .ba_escape_timer = ((__uint32_t)(6)),
.bf_enable_beacon_filter = htole32(1)((__uint32_t)(1)),
.ba_enable_beacon_abort = htole32(sc->sc_bf.ba_enabled)((__uint32_t)(sc->sc_bf.ba_enabled)),
};
int err;

err = iwx_beacon_filter_send_cmd(sc, &cmd);
if (err == 0)
sc->sc_bf.bf_enabled = 1;

return err;
5767}

5769int
5770iwx_disable_beacon_filter(struct iwx_softc *sc)
5771{
struct iwx_beacon_filter_cmd cmd;
int err;

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));

err = iwx_beacon_filter_send_cmd(sc, &cmd);
if (err == 0)
sc->sc_bf.bf_enabled = 0;

return err;
5782}

5784int
5785iwx_add_sta_cmd(struct iwx_softc *sc, struct iwx_node *in, int update)
5786{
struct iwx_add_sta_cmd add_sta_cmd;
int err;
uint32_t status;
struct ieee80211com *ic = &sc->sc_ic;

if (!update && (sc->sc_flags & IWX_FLAG_STA_ACTIVE0x20))
panic("STA already added");

memset(&add_sta_cmd, 0, sizeof(add_sta_cmd))__builtin_memset((&add_sta_cmd), (0), (sizeof(add_sta_cmd
)));

if (ic->ic_opmode == IEEE80211_M_MONITOR) {
add_sta_cmd.sta_id = IWX_MONITOR_STA_ID2;
add_sta_cmd.station_type = IWX_STA_GENERAL_PURPOSE1;
} else {
add_sta_cmd.sta_id = IWX_STATION_ID0;
add_sta_cmd.station_type = IWX_STA_LINK0;
}
add_sta_cmd.mac_id_n_color
   = htole32(IWX_FW_CMD_ID_AND_COLOR(in->in_id, in->in_color))((__uint32_t)(((in->in_id << (0)) | (in->in_color
 << (8)))));
if (!update) {
if (ic->ic_opmode == IEEE80211_M_MONITOR)
	IEEE80211_ADDR_COPY(&add_sta_cmd.addr,__builtin_memcpy((&add_sta_cmd.addr), (etheranyaddr), (6)
)
	    etheranyaddr)__builtin_memcpy((&add_sta_cmd.addr), (etheranyaddr), (6)
);
else
	IEEE80211_ADDR_COPY(&add_sta_cmd.addr,__builtin_memcpy((&add_sta_cmd.addr), (in->in_macaddr)
, (6))
	    in->in_macaddr)__builtin_memcpy((&add_sta_cmd.addr), (in->in_macaddr)
, (6));
}
add_sta_cmd.add_modify = update ? 1 : 0;
add_sta_cmd.station_flags_msk
   |= htole32(IWX_STA_FLG_FAT_EN_MSK | IWX_STA_FLG_MIMO_EN_MSK)((__uint32_t)((3 << 26) | (3 << 28)));

if (in->in_ni.ni_flags & IEEE80211_NODE_HT0x0400) {
add_sta_cmd.station_flags_msk
    |= htole32(IWX_STA_FLG_MAX_AGG_SIZE_MSK |((__uint32_t)((7 << 19) | (7 << 23)))
    IWX_STA_FLG_AGG_MPDU_DENS_MSK)((__uint32_t)((7 << 19) | (7 << 23)));

if (iwx_mimo_enabled(sc)) {
	if (in->in_ni.ni_rxmcs[1] != 0) {
		add_sta_cmd.station_flags |=
		    htole32(IWX_STA_FLG_MIMO_EN_MIMO2)((__uint32_t)((1 << 28)));
	}
	if (in->in_ni.ni_rxmcs[2] != 0) {
		add_sta_cmd.station_flags |=
		    htole32(IWX_STA_FLG_MIMO_EN_MIMO3)((__uint32_t)((2 << 28)));
	}
}

if (ieee80211_node_supports_ht_chan40(&in->in_ni)) {
	add_sta_cmd.station_flags |= htole32(((__uint32_t)((1 << 26)))
	    IWX_STA_FLG_FAT_EN_40MHZ)((__uint32_t)((1 << 26)));
}

add_sta_cmd.station_flags
    |= htole32(IWX_STA_FLG_MAX_AGG_SIZE_64K)((__uint32_t)((3 << 19)));
switch (ic->ic_ampdu_params & IEEE80211_AMPDU_PARAM_SS0x1c) {
case IEEE80211_AMPDU_PARAM_SS_2(4 << 2):
	add_sta_cmd.station_flags
	    |= htole32(IWX_STA_FLG_AGG_MPDU_DENS_2US)((__uint32_t)((4 << 23)));
	break;
case IEEE80211_AMPDU_PARAM_SS_4(5 << 2):
	add_sta_cmd.station_flags
	    |= htole32(IWX_STA_FLG_AGG_MPDU_DENS_4US)((__uint32_t)((5 << 23)));
	break;
case IEEE80211_AMPDU_PARAM_SS_8(6 << 2):
	add_sta_cmd.station_flags
	    |= htole32(IWX_STA_FLG_AGG_MPDU_DENS_8US)((__uint32_t)((6 << 23)));
	break;
case IEEE80211_AMPDU_PARAM_SS_16(7 << 2):
	add_sta_cmd.station_flags
	    |= htole32(IWX_STA_FLG_AGG_MPDU_DENS_16US)((__uint32_t)((7 << 23)));
	break;
default:
	break;
}
}

status = IWX_ADD_STA_SUCCESS0x1;
err = iwx_send_cmd_pdu_status(sc, IWX_ADD_STA0x18, sizeof(add_sta_cmd),
   &add_sta_cmd, &status);
if (!err && (status & IWX_ADD_STA_STATUS_MASK0xFF) != IWX_ADD_STA_SUCCESS0x1)
err = EIO5;

return err;
5870}

5872int
5873iwx_rm_sta_cmd(struct iwx_softc *sc, struct iwx_node *in)
5874{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_rm_sta_cmd rm_sta_cmd;
int err;

if ((sc->sc_flags & IWX_FLAG_STA_ACTIVE0x20) == 0)
panic("sta already removed");

memset(&rm_sta_cmd, 0, sizeof(rm_sta_cmd))__builtin_memset((&rm_sta_cmd), (0), (sizeof(rm_sta_cmd))
);
if (ic->ic_opmode == IEEE80211_M_MONITOR)
rm_sta_cmd.sta_id = IWX_MONITOR_STA_ID2;
else
rm_sta_cmd.sta_id = IWX_STATION_ID0;

err = iwx_send_cmd_pdu(sc, IWX_REMOVE_STA0x19, 0, sizeof(rm_sta_cmd),
   &rm_sta_cmd);

return err;
5892}

5894int
5895iwx_rm_sta(struct iwx_softc *sc, struct iwx_node *in)
5896{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni = &in->in_ni;
int err, i;

err = iwx_flush_sta(sc, in);
if (err) {
printf("%s: could not flush Tx path (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
}
err = iwx_rm_sta_cmd(sc, in);
if (err) {
printf("%s: could not remove STA (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
}

in->in_flags = 0;

sc->sc_rx_ba_sessions = 0;
sc->ba_rx.start_tidmask = 0;
sc->ba_rx.stop_tidmask = 0;
memset(sc->aggqid, 0, sizeof(sc->aggqid))__builtin_memset((sc->aggqid), (0), (sizeof(sc->aggqid)
));
sc->ba_tx.start_tidmask = 0;
sc->ba_tx.stop_tidmask = 0;
for (i = IWX_FIRST_AGG_TX_QUEUE(1 + 1); i < IWX_LAST_AGG_TX_QUEUE((1 + 1) + 8 - 1); i++)
sc->qenablemsk &= ~(1 << i);
for (i = 0; i < IEEE80211_NUM_TID16; i++) {
struct ieee80211_tx_ba *ba = &ni->ni_tx_ba[i];
if (ba->ba_state != IEEE80211_BA_AGREED2)
	continue;
ieee80211_delba_request(ic, ni, 0, 1, i);
}

return 0;
5932}

5934uint8_t
5935iwx_umac_scan_fill_channels(struct iwx_softc *sc,
  struct iwx_scan_channel_cfg_umac *chan, size_t chan_nitems,
  int n_ssids, int bgscan)
5938{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_channel *c;
uint8_t nchan;

for (nchan = 0, c = &ic->ic_channels[1];
   c <= &ic->ic_channels[IEEE80211_CHAN_MAX255] &&
   nchan < chan_nitems &&
   nchan < sc->sc_capa_n_scan_channels;
   c++) {
uint8_t channel_num;

if (c->ic_flags == 0)
	continue;

channel_num = ieee80211_mhz2ieee(c->ic_freq, 0);
if (isset(sc->sc_ucode_api,((sc->sc_ucode_api)[(58)>>3] & (1<<((58)&
(8 -1))))
    IWX_UCODE_TLV_API_SCAN_EXT_CHAN_VER)((sc->sc_ucode_api)[(58)>>3] & (1<<((58)&
(8 -1))))) {
	chan->v2.channel_num = channel_num;
	if (IEEE80211_IS_CHAN_2GHZ(c)(((c)->ic_flags & 0x0080) != 0))
		chan->v2.band = IWX_PHY_BAND_24(1);
	else
		chan->v2.band = IWX_PHY_BAND_5(0);
	chan->v2.iter_count = 1;
	chan->v2.iter_interval = 0;
} else {
	chan->v1.channel_num = channel_num;
	chan->v1.iter_count = 1;
	chan->v1.iter_interval = htole16(0)((__uint16_t)(0));
}
/*
 * Firmware may become unresponsive when asked to send
 * a directed probe request on a passive channel.
 */
5972#if 0 /* Some people see "device timeout" after active scans. */
if (n_ssids != 0 && !bgscan &&
    (c->ic_flags & IEEE80211_CHAN_PASSIVE0x0200) == 0)
	chan->flags = htole32(1 << 0)((__uint32_t)(1 << 0)); /* select SSID 0 */
5976#endif
chan++;
nchan++;
}

return nchan;
5982}

5984int
5985iwx_fill_probe_req(struct iwx_softc *sc, struct iwx_scan_probe_req *preq)
5986{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_frame *wh = (struct ieee80211_frame *)preq->buf;
struct ieee80211_rateset *rs;
size_t remain = sizeof(preq->buf);
uint8_t *frm, *pos;

memset(preq, 0, sizeof(*preq))__builtin_memset((preq), (0), (sizeof(*preq)));

if (remain < sizeof(*wh) + 2)
return ENOBUFS55;

/*
* Build a probe request frame.  Most of the following code is a
* copy & paste of what is done in net80211.
*/
wh->i_fc[0] = IEEE80211_FC0_VERSION_00x00 | IEEE80211_FC0_TYPE_MGT0x00 |
   IEEE80211_FC0_SUBTYPE_PROBE_REQ0x40;
wh->i_fc[1] = IEEE80211_FC1_DIR_NODS0x00;
IEEE80211_ADDR_COPY(wh->i_addr1, etherbroadcastaddr)__builtin_memcpy((wh->i_addr1), (etherbroadcastaddr), (6));
IEEE80211_ADDR_COPY(wh->i_addr2, ic->ic_myaddr)__builtin_memcpy((wh->i_addr2), (ic->ic_myaddr), (6));
IEEE80211_ADDR_COPY(wh->i_addr3, etherbroadcastaddr)__builtin_memcpy((wh->i_addr3), (etherbroadcastaddr), (6));
*(uint16_t *)&wh->i_dur[0] = 0;	/* filled by HW */
*(uint16_t *)&wh->i_seq[0] = 0;	/* filled by HW */

frm = (uint8_t *)(wh + 1);
*frm++ = IEEE80211_ELEMID_SSID;
*frm++ = 0;
/* hardware inserts SSID */

/* Tell the firmware where the MAC header is. */
preq->mac_header.offset = 0;
preq->mac_header.len = htole16(frm - (uint8_t *)wh)((__uint16_t)(frm - (uint8_t *)wh));
remain -= frm - (uint8_t *)wh;

/* Fill in 2GHz IEs and tell firmware where they are. */
rs = &ic->ic_sup_rates[IEEE80211_MODE_11G];
if (rs->rs_nrates > IEEE80211_RATE_SIZE8) {
if (remain < 4 + rs->rs_nrates)
	return ENOBUFS55;
} else if (remain < 2 + rs->rs_nrates)
return ENOBUFS55;
preq->band_data[0].offset = htole16(frm - (uint8_t *)wh)((__uint16_t)(frm - (uint8_t *)wh));
pos = frm;
frm = ieee80211_add_rates(frm, rs);
if (rs->rs_nrates > IEEE80211_RATE_SIZE8)
frm = ieee80211_add_xrates(frm, rs);
remain -= frm - pos;

if (isset(sc->sc_enabled_capa,((sc->sc_enabled_capa)[(9)>>3] & (1<<((9)&
(8 -1)))) 
   IWX_UCODE_TLV_CAPA_DS_PARAM_SET_IE_SUPPORT)((sc->sc_enabled_capa)[(9)>>3] & (1<<((9)&
(8 -1))))) {
if (remain < 3)
	return ENOBUFS55;
*frm++ = IEEE80211_ELEMID_DSPARMS;
*frm++ = 1;
*frm++ = 0;
remain -= 3;
}
preq->band_data[0].len = htole16(frm - pos)((__uint16_t)(frm - pos));

if (sc->sc_nvm.sku_cap_band_52GHz_enable) {
/* Fill in 5GHz IEs. */
rs = &ic->ic_sup_rates[IEEE80211_MODE_11A];
if (rs->rs_nrates > IEEE80211_RATE_SIZE8) {
	if (remain < 4 + rs->rs_nrates)
		return ENOBUFS55;
} else if (remain < 2 + rs->rs_nrates)
	return ENOBUFS55;
preq->band_data[1].offset = htole16(frm - (uint8_t *)wh)((__uint16_t)(frm - (uint8_t *)wh));
pos = frm;
frm = ieee80211_add_rates(frm, rs);
if (rs->rs_nrates > IEEE80211_RATE_SIZE8)
	frm = ieee80211_add_xrates(frm, rs);
preq->band_data[1].len = htole16(frm - pos)((__uint16_t)(frm - pos));
remain -= frm - pos;
}

/* Send 11n IEs on both 2GHz and 5GHz bands. */
preq->common_data.offset = htole16(frm - (uint8_t *)wh)((__uint16_t)(frm - (uint8_t *)wh));
pos = frm;
if (ic->ic_flags & IEEE80211_F_HTON0x02000000) {
if (remain < 28)
	return ENOBUFS55;
frm = ieee80211_add_htcaps(frm, ic);
/* XXX add WME info? */
}
preq->common_data.len = htole16(frm - pos)((__uint16_t)(frm - pos));

return 0;
6075}

6077int
6078iwx_config_umac_scan_reduced(struct iwx_softc *sc)
6079{
struct iwx_scan_config scan_cfg;
struct iwx_host_cmd hcmd = {
.id = iwx_cmd_id(IWX_SCAN_CFG_CMD0xc, IWX_LONG_GROUP0x1, 0),
.len[0] = sizeof(scan_cfg),
.data[0] = &scan_cfg,
.flags = 0,
};
int cmdver;

if (!isset(sc->sc_ucode_api, IWX_UCODE_TLV_API_REDUCED_SCAN_CONFIG)((sc->sc_ucode_api)[(56)>>3] & (1<<((56)&
(8 -1))))) {
printf("%s: firmware does not support reduced scan config\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
return ENOTSUP91;
}

memset(&scan_cfg, 0, sizeof(scan_cfg))__builtin_memset((&scan_cfg), (0), (sizeof(scan_cfg)));

/*
* SCAN_CFG version >= 5 implies that the broadcast
* STA ID field is deprecated.
*/
cmdver = iwx_lookup_cmd_ver(sc, IWX_LONG_GROUP0x1, IWX_SCAN_CFG_CMD0xc);
if (cmdver == IWX_FW_CMD_VER_UNKNOWN99 || cmdver < 5)
scan_cfg.bcast_sta_id = 0xff;

scan_cfg.tx_chains = htole32(iwx_fw_valid_tx_ant(sc))((__uint32_t)(iwx_fw_valid_tx_ant(sc)));
scan_cfg.rx_chains = htole32(iwx_fw_valid_rx_ant(sc))((__uint32_t)(iwx_fw_valid_rx_ant(sc)));

return iwx_send_cmd(sc, &hcmd);
6109}

6111uint16_t
6112iwx_scan_umac_flags_v2(struct iwx_softc *sc, int bgscan)
6113{
struct ieee80211com *ic = &sc->sc_ic;
uint16_t flags = 0;

if (ic->ic_des_esslen == 0)
flags |= IWX_UMAC_SCAN_GEN_FLAGS_V2_FORCE_PASSIVE(1 << 11);

flags |= IWX_UMAC_SCAN_GEN_FLAGS_V2_PASS_ALL(1 << 1);
flags |= IWX_UMAC_SCAN_GEN_FLAGS_V2_NTFY_ITER_COMPLETE(1 << 2);
flags |= IWX_UMAC_SCAN_GEN_FLAGS_V2_ADAPTIVE_DWELL(1 << 7);

return flags;
6125}

6127#define IWX_SCAN_DWELL_ACTIVE10		10
6128#define IWX_SCAN_DWELL_PASSIVE110		110

6130/* adaptive dwell max budget time [TU] for full scan */
6131#define IWX_SCAN_ADWELL_MAX_BUDGET_FULL_SCAN300 300
6132/* adaptive dwell max budget time [TU] for directed scan */
6133#define IWX_SCAN_ADWELL_MAX_BUDGET_DIRECTED_SCAN100 100
6134/* adaptive dwell default high band APs number */
6135#define IWX_SCAN_ADWELL_DEFAULT_HB_N_APS8 8
6136/* adaptive dwell default low band APs number */
6137#define IWX_SCAN_ADWELL_DEFAULT_LB_N_APS2 2
6138/* adaptive dwell default APs number in social channels (1, 6, 11) */
6139#define IWX_SCAN_ADWELL_DEFAULT_N_APS_SOCIAL10 10
6140/* adaptive dwell number of APs override for p2p friendly GO channels */
6141#define IWX_SCAN_ADWELL_N_APS_GO_FRIENDLY10 10
6142/* adaptive dwell number of APs override for social channels */
6143#define IWX_SCAN_ADWELL_N_APS_SOCIAL_CHS2 2

6145void
6146iwx_scan_umac_dwell_v10(struct iwx_softc *sc,
  struct iwx_scan_general_params_v10 *general_params, int bgscan)
6148{
uint32_t suspend_time, max_out_time;
uint8_t active_dwell, passive_dwell;

active_dwell = IWX_SCAN_DWELL_ACTIVE10;
passive_dwell = IWX_SCAN_DWELL_PASSIVE110;

general_params->adwell_default_social_chn =
IWX_SCAN_ADWELL_DEFAULT_N_APS_SOCIAL10;
general_params->adwell_default_2g = IWX_SCAN_ADWELL_DEFAULT_LB_N_APS2;
general_params->adwell_default_5g = IWX_SCAN_ADWELL_DEFAULT_HB_N_APS8;

if (bgscan)
general_params->adwell_max_budget =
	htole16(IWX_SCAN_ADWELL_MAX_BUDGET_DIRECTED_SCAN)((__uint16_t)(100));
else
general_params->adwell_max_budget =
	htole16(IWX_SCAN_ADWELL_MAX_BUDGET_FULL_SCAN)((__uint16_t)(300));

general_params->scan_priority = htole32(IWX_SCAN_PRIORITY_EXT_6)((__uint32_t)(IWX_SCAN_PRIORITY_EXT_6));
if (bgscan) {
max_out_time = htole32(120)((__uint32_t)(120));
suspend_time = htole32(120)((__uint32_t)(120));
} else {
max_out_time = htole32(0)((__uint32_t)(0));
suspend_time = htole32(0)((__uint32_t)(0));
}
general_params->max_out_of_time[IWX_SCAN_LB_LMAC_IDX0] =
htole32(max_out_time)((__uint32_t)(max_out_time));
general_params->suspend_time[IWX_SCAN_LB_LMAC_IDX0] =
htole32(suspend_time)((__uint32_t)(suspend_time));
general_params->max_out_of_time[IWX_SCAN_HB_LMAC_IDX1] =
htole32(max_out_time)((__uint32_t)(max_out_time));
general_params->suspend_time[IWX_SCAN_HB_LMAC_IDX1] =
htole32(suspend_time)((__uint32_t)(suspend_time));

general_params->active_dwell[IWX_SCAN_LB_LMAC_IDX0] = active_dwell;
general_params->passive_dwell[IWX_SCAN_LB_LMAC_IDX0] = passive_dwell;
general_params->active_dwell[IWX_SCAN_HB_LMAC_IDX1] = active_dwell;
general_params->passive_dwell[IWX_SCAN_HB_LMAC_IDX1] = passive_dwell;
6188}

6190void
6191iwx_scan_umac_fill_general_p_v10(struct iwx_softc *sc,
  struct iwx_scan_general_params_v10 *gp, uint16_t gen_flags, int bgscan)
6193{
iwx_scan_umac_dwell_v10(sc, gp, bgscan);

gp->flags = htole16(gen_flags)((__uint16_t)(gen_flags));

if (gen_flags & IWX_UMAC_SCAN_GEN_FLAGS_V2_FRAGMENTED_LMAC1(1 << 3))
gp->num_of_fragments[IWX_SCAN_LB_LMAC_IDX0] = 3;
if (gen_flags & IWX_UMAC_SCAN_GEN_FLAGS_V2_FRAGMENTED_LMAC2(1 << 4))
gp->num_of_fragments[IWX_SCAN_HB_LMAC_IDX1] = 3;

gp->scan_start_mac_id = 0;
6204}

6206void
6207iwx_scan_umac_fill_ch_p_v6(struct iwx_softc *sc,
  struct iwx_scan_channel_params_v6 *cp, uint32_t channel_cfg_flags,
  int n_ssid, int bgscan)
6210{
cp->flags = IWX_SCAN_CHANNEL_FLAG_ENABLE_CHAN_ORDER(1 << 5);

cp->count = iwx_umac_scan_fill_channels(sc, cp->channel_config,
   nitems(cp->channel_config)(sizeof((cp->channel_config)) / sizeof((cp->channel_config
)[0])), n_ssid, bgscan);

cp->n_aps_override[0] = IWX_SCAN_ADWELL_N_APS_GO_FRIENDLY10;
cp->n_aps_override[1] = IWX_SCAN_ADWELL_N_APS_SOCIAL_CHS2;
6218}

6220int
6221iwx_umac_scan_v14(struct iwx_softc *sc, int bgscan)
6222{
6223#if 0 /* Some people see "device timeout" after active scans. */
struct ieee80211com *ic = &sc->sc_ic;
6225#endif
struct iwx_host_cmd hcmd = {
.id = iwx_cmd_id(IWX_SCAN_REQ_UMAC0xd, IWX_LONG_GROUP0x1, 0),
.len = { 0, },
.data = { NULL((void *)0), },
.flags = 0,
};
struct iwx_scan_req_umac_v14 *cmd;
struct iwx_scan_req_params_v14 *scan_p;
int err, async = bgscan, n_ssid = 0;
uint16_t gen_flags;
uint32_t bitmap_ssid = 0;

cmd = malloc(sizeof(*cmd), M_DEVBUF2,
   (async ? M_NOWAIT0x0002 : M_WAIT0x0001) | M_CANFAIL0x0004 | M_ZERO0x0008);
if (cmd == NULL((void *)0))
return ENOMEM12;

scan_p = &cmd->scan_params;

cmd->ooc_priority = htole32(IWX_SCAN_PRIORITY_EXT_6)((__uint32_t)(IWX_SCAN_PRIORITY_EXT_6));
cmd->uid = htole32(0)((__uint32_t)(0));

gen_flags = iwx_scan_umac_flags_v2(sc, bgscan);
iwx_scan_umac_fill_general_p_v10(sc, &scan_p->general_params,
   gen_flags, bgscan);

scan_p->periodic_params.schedule[0].interval = htole16(0)((__uint16_t)(0));
scan_p->periodic_params.schedule[0].iter_count = 1;

err = iwx_fill_probe_req(sc, &scan_p->probe_params.preq);
if (err) {
free(cmd, M_DEVBUF2, sizeof(*cmd));
return err;
}

6261#if 0 /* Some people see "device timeout" after active scans. */
if (ic->ic_des_esslen != 0) {
scan_p->probe_params.direct_scan[0].id = IEEE80211_ELEMID_SSID;
scan_p->probe_params.direct_scan[0].len = ic->ic_des_esslen;
memcpy(scan_p->probe_params.direct_scan[0].ssid,__builtin_memcpy((scan_p->probe_params.direct_scan[0].ssid
), (ic->ic_des_essid), (ic->ic_des_esslen))
    ic->ic_des_essid, ic->ic_des_esslen)__builtin_memcpy((scan_p->probe_params.direct_scan[0].ssid
), (ic->ic_des_essid), (ic->ic_des_esslen));
bitmap_ssid |= (1 << 0);
n_ssid = 1;
}
6270#endif

iwx_scan_umac_fill_ch_p_v6(sc, &scan_p->channel_params, bitmap_ssid,
   n_ssid, bgscan);

hcmd.len[0] = sizeof(*cmd);
hcmd.data[0] = (void *)cmd;
hcmd.flags |= async ? IWX_CMD_ASYNC : 0;

err = iwx_send_cmd(sc, &hcmd);
free(cmd, M_DEVBUF2, sizeof(*cmd));
return err;
6282}

6284void
6285iwx_mcc_update(struct iwx_softc *sc, struct iwx_mcc_chub_notif *notif)
6286{
struct ieee80211com *ic = &sc->sc_ic;
struct ifnet *ifp = IC2IFP(ic)(&(ic)->ic_ac.ac_if);
char alpha2[3];

snprintf(alpha2, sizeof(alpha2), "%c%c",
   (le16toh(notif->mcc)((__uint16_t)(notif->mcc)) & 0xff00) >> 8, le16toh(notif->mcc)((__uint16_t)(notif->mcc)) & 0xff);

if (ifp->if_flags & IFF_DEBUG0x4) {
printf("%s: firmware has detected regulatory domain '%s' "
    "(0x%x)\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), alpha2, le16toh(notif->mcc)((__uint16_t)(notif->mcc)));
}

/* TODO: Schedule a task to send MCC_UPDATE_CMD? */
6300}

6302uint8_t
6303iwx_ridx2rate(struct ieee80211_rateset *rs, int ridx)
6304{
int i;
uint8_t rval;

for (i = 0; i < rs->rs_nrates; i++) {
rval = (rs->rs_rates[i] & IEEE80211_RATE_VAL0x7f);
if (rval == iwx_rates[ridx].rate)
	return rs->rs_rates[i];
}

return 0;
6315}

6317int
6318iwx_rval2ridx(int rval)
6319{
int ridx;

for (ridx = 0; ridx < nitems(iwx_rates)(sizeof((iwx_rates)) / sizeof((iwx_rates)[0])); ridx++) {
if (iwx_rates[ridx].plcp == IWX_RATE_INVM_PLCP0xff)
	continue;
if (rval == iwx_rates[ridx].rate)
	break;
}

     return ridx;
6330}

6332void
6333iwx_ack_rates(struct iwx_softc *sc, struct iwx_node *in, int *cck_rates,
  int *ofdm_rates)
6335{
struct ieee80211_node *ni = &in->in_ni;
struct ieee80211_rateset *rs = &ni->ni_rates;
int lowest_present_ofdm = -1;
int lowest_present_cck = -1;
uint8_t cck = 0;
uint8_t ofdm = 0;
int i;

if (ni->ni_chan == IEEE80211_CHAN_ANYC((struct ieee80211_channel *) ((void *)0)) ||
   IEEE80211_IS_CHAN_2GHZ(ni->ni_chan)(((ni->ni_chan)->ic_flags & 0x0080) != 0)) {
for (i = IWX_FIRST_CCK_RATE; i < IWX_FIRST_OFDM_RATE; i++) {
	if ((iwx_ridx2rate(rs, i) & IEEE80211_RATE_BASIC0x80) == 0)
		continue;
	cck |= (1 << i);
	if (lowest_present_cck == -1 || lowest_present_cck > i)
		lowest_present_cck = i;
}
}
for (i = IWX_FIRST_OFDM_RATE; i <= IWX_LAST_NON_HT_RATE; i++) {
if ((iwx_ridx2rate(rs, i) & IEEE80211_RATE_BASIC0x80) == 0)
	continue;	
ofdm |= (1 << (i - IWX_FIRST_OFDM_RATE));
if (lowest_present_ofdm == -1 || lowest_present_ofdm > i)
	lowest_present_ofdm = i;
}

/*
* Now we've got the basic rates as bitmaps in the ofdm and cck
* variables. This isn't sufficient though, as there might not
* be all the right rates in the bitmap. E.g. if the only basic
* rates are 5.5 Mbps and 11 Mbps, we still need to add 1 Mbps
* and 6 Mbps because the 802.11-2007 standard says in 9.6:
*
*    [...] a STA responding to a received frame shall transmit
*    its Control Response frame [...] at the highest rate in the
*    BSSBasicRateSet parameter that is less than or equal to the
*    rate of the immediately previous frame in the frame exchange
*    sequence ([...]) and that is of the same modulation class
*    ([...]) as the received frame. If no rate contained in the
*    BSSBasicRateSet parameter meets these conditions, then the
*    control frame sent in response to a received frame shall be
*    transmitted at the highest mandatory rate of the PHY that is
*    less than or equal to the rate of the received frame, and
*    that is of the same modulation class as the received frame.
*
* As a consequence, we need to add all mandatory rates that are
* lower than all of the basic rates to these bitmaps.
*/

if (IWX_RATE_24M_INDEX < lowest_present_ofdm)
ofdm |= IWX_RATE_BIT_MSK(24)(1 << (IWX_RATE_24M_INDEX)) >> IWX_FIRST_OFDM_RATE;
if (IWX_RATE_12M_INDEX < lowest_present_ofdm)
ofdm |= IWX_RATE_BIT_MSK(12)(1 << (IWX_RATE_12M_INDEX)) >> IWX_FIRST_OFDM_RATE;
/* 6M already there or needed so always add */
ofdm |= IWX_RATE_BIT_MSK(6)(1 << (IWX_RATE_6M_INDEX)) >> IWX_FIRST_OFDM_RATE;

/*
* CCK is a bit more complex with DSSS vs. HR/DSSS vs. ERP.
* Note, however:
*  - if no CCK rates are basic, it must be ERP since there must
*    be some basic rates at all, so they're OFDM => ERP PHY
*    (or we're in 5 GHz, and the cck bitmap will never be used)
*  - if 11M is a basic rate, it must be ERP as well, so add 5.5M
*  - if 5.5M is basic, 1M and 2M are mandatory
*  - if 2M is basic, 1M is mandatory
*  - if 1M is basic, that's the only valid ACK rate.
* As a consequence, it's not as complicated as it sounds, just add
* any lower rates to the ACK rate bitmap.
*/
if (IWX_RATE_11M_INDEX < lowest_present_cck)
cck |= IWX_RATE_BIT_MSK(11)(1 << (IWX_RATE_11M_INDEX)) >> IWX_FIRST_CCK_RATE;
if (IWX_RATE_5M_INDEX < lowest_present_cck)
cck |= IWX_RATE_BIT_MSK(5)(1 << (IWX_RATE_5M_INDEX)) >> IWX_FIRST_CCK_RATE;
if (IWX_RATE_2M_INDEX < lowest_present_cck)
cck |= IWX_RATE_BIT_MSK(2)(1 << (IWX_RATE_2M_INDEX)) >> IWX_FIRST_CCK_RATE;
/* 1M already there or needed so always add */
cck |= IWX_RATE_BIT_MSK(1)(1 << (IWX_RATE_1M_INDEX)) >> IWX_FIRST_CCK_RATE;

*cck_rates = cck;
*ofdm_rates = ofdm;
6416}

6418void
6419iwx_mac_ctxt_cmd_common(struct iwx_softc *sc, struct iwx_node *in,
  struct iwx_mac_ctx_cmd *cmd, uint32_t action)
6421{
6422#define IWX_EXP2(x)	((1 << (x)) - 1)	/* CWmin = 2^ECWmin - 1 */
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni = ic->ic_bss;
int cck_ack_rates, ofdm_ack_rates;
int i;

cmd->id_and_color = htole32(IWX_FW_CMD_ID_AND_COLOR(in->in_id,((__uint32_t)(((in->in_id << (0)) | (in->in_color
 << (8)))))
   in->in_color))((__uint32_t)(((in->in_id << (0)) | (in->in_color
 << (8)))));
cmd->action = htole32(action)((__uint32_t)(action));

if (action == IWX_FW_CTXT_ACTION_REMOVE3)
return;

if (ic->ic_opmode == IEEE80211_M_MONITOR)
cmd->mac_type = htole32(IWX_FW_MAC_TYPE_LISTENER)((__uint32_t)(2));
else if (ic->ic_opmode == IEEE80211_M_STA)
cmd->mac_type = htole32(IWX_FW_MAC_TYPE_BSS_STA)((__uint32_t)(5));
else
panic("unsupported operating mode %d", ic->ic_opmode);
cmd->tsf_id = htole32(IWX_TSF_ID_A)((__uint32_t)(0));

IEEE80211_ADDR_COPY(cmd->node_addr, ic->ic_myaddr)__builtin_memcpy((cmd->node_addr), (ic->ic_myaddr), (6)
);
if (ic->ic_opmode == IEEE80211_M_MONITOR) {
IEEE80211_ADDR_COPY(cmd->bssid_addr, etherbroadcastaddr)__builtin_memcpy((cmd->bssid_addr), (etherbroadcastaddr), (
6));
return;
}

IEEE80211_ADDR_COPY(cmd->bssid_addr, in->in_macaddr)__builtin_memcpy((cmd->bssid_addr), (in->in_macaddr), (
6));
iwx_ack_rates(sc, in, &cck_ack_rates, &ofdm_ack_rates);
cmd->cck_rates = htole32(cck_ack_rates)((__uint32_t)(cck_ack_rates));
cmd->ofdm_rates = htole32(ofdm_ack_rates)((__uint32_t)(ofdm_ack_rates));

cmd->cck_short_preamble
   = htole32((ic->ic_flags & IEEE80211_F_SHPREAMBLE)((__uint32_t)((ic->ic_flags & 0x00040000) ? (1 <<
 5) : 0))
     ? IWX_MAC_FLG_SHORT_PREAMBLE : 0)((__uint32_t)((ic->ic_flags & 0x00040000) ? (1 <<
 5) : 0));
cmd->short_slot
   = htole32((ic->ic_flags & IEEE80211_F_SHSLOT)((__uint32_t)((ic->ic_flags & 0x00020000) ? (1 <<
 4) : 0))
     ? IWX_MAC_FLG_SHORT_SLOT : 0)((__uint32_t)((ic->ic_flags & 0x00020000) ? (1 <<
 4) : 0));

for (i = 0; i < EDCA_NUM_AC4; i++) {
struct ieee80211_edca_ac_params *ac = &ic->ic_edca_ac[i];
int txf = iwx_ac_to_tx_fifo[i];

cmd->ac[txf].cw_min = htole16(IWX_EXP2(ac->ac_ecwmin))((__uint16_t)(IWX_EXP2(ac->ac_ecwmin)));
cmd->ac[txf].cw_max = htole16(IWX_EXP2(ac->ac_ecwmax))((__uint16_t)(IWX_EXP2(ac->ac_ecwmax)));
cmd->ac[txf].aifsn = ac->ac_aifsn;
cmd->ac[txf].fifos_mask = (1 << txf);
cmd->ac[txf].edca_txop = htole16(ac->ac_txoplimit * 32)((__uint16_t)(ac->ac_txoplimit * 32));
}
if (ni->ni_flags & IEEE80211_NODE_QOS0x0002)
cmd->qos_flags |= htole32(IWX_MAC_QOS_FLG_UPDATE_EDCA)((__uint32_t)((1 << 0)));

if (ni->ni_flags & IEEE80211_NODE_HT0x0400) {
enum ieee80211_htprot htprot =
    (ni->ni_htop1 & IEEE80211_HTOP1_PROT_MASK0x0003);
switch (htprot) {
case IEEE80211_HTPROT_NONE:
	break;
case IEEE80211_HTPROT_NONMEMBER:
case IEEE80211_HTPROT_NONHT_MIXED:
	cmd->protection_flags |=
	    htole32(IWX_MAC_PROT_FLG_HT_PROT |((__uint32_t)((1 << 23) | (1 << 24)))
	    IWX_MAC_PROT_FLG_FAT_PROT)((__uint32_t)((1 << 23) | (1 << 24)));
	break;
case IEEE80211_HTPROT_20MHZ:
	if (in->in_phyctxt &&
	    (in->in_phyctxt->sco == IEEE80211_HTOP0_SCO_SCA1 ||
	    in->in_phyctxt->sco == IEEE80211_HTOP0_SCO_SCB3)) {
		cmd->protection_flags |=
		    htole32(IWX_MAC_PROT_FLG_HT_PROT |((__uint32_t)((1 << 23) | (1 << 24)))
		    IWX_MAC_PROT_FLG_FAT_PROT)((__uint32_t)((1 << 23) | (1 << 24)));
	}
	break;
default:
	break;
}

cmd->qos_flags |= htole32(IWX_MAC_QOS_FLG_TGN)((__uint32_t)((1 << 1)));
}
if (ic->ic_flags & IEEE80211_F_USEPROT0x00100000)
cmd->protection_flags |= htole32(IWX_MAC_PROT_FLG_TGG_PROTECT)((__uint32_t)((1 << 3)));

cmd->filter_flags = htole32(IWX_MAC_FILTER_ACCEPT_GRP)((__uint32_t)((1 << 2)));
6505#undef IWX_EXP2
6506}

6508void
6509iwx_mac_ctxt_cmd_fill_sta(struct iwx_softc *sc, struct iwx_node *in,
  struct iwx_mac_data_sta *sta, int assoc)
6511{
struct ieee80211_node *ni = &in->in_ni;
uint32_t dtim_off;
uint64_t tsf;

dtim_off = ni->ni_dtimcount * ni->ni_intval * IEEE80211_DUR_TU1024;
memcpy(&tsf, ni->ni_tstamp, sizeof(tsf))__builtin_memcpy((&tsf), (ni->ni_tstamp), (sizeof(tsf)
));
tsf = letoh64(tsf)((__uint64_t)(tsf));

sta->is_assoc = htole32(assoc)((__uint32_t)(assoc));
sta->dtim_time = htole32(ni->ni_rstamp + dtim_off)((__uint32_t)(ni->ni_rstamp + dtim_off));
sta->dtim_tsf = htole64(tsf + dtim_off)((__uint64_t)(tsf + dtim_off));
sta->bi = htole32(ni->ni_intval)((__uint32_t)(ni->ni_intval));
sta->bi_reciprocal = htole32(iwx_reciprocal(ni->ni_intval))((__uint32_t)(iwx_reciprocal(ni->ni_intval)));
sta->dtim_interval = htole32(ni->ni_intval * ni->ni_dtimperiod)((__uint32_t)(ni->ni_intval * ni->ni_dtimperiod));
sta->dtim_reciprocal = htole32(iwx_reciprocal(sta->dtim_interval))((__uint32_t)(iwx_reciprocal(sta->dtim_interval)));
sta->listen_interval = htole32(10)((__uint32_t)(10));
sta->assoc_id = htole32(ni->ni_associd)((__uint32_t)(ni->ni_associd));
sta->assoc_beacon_arrive_time = htole32(ni->ni_rstamp)((__uint32_t)(ni->ni_rstamp));
6530}

6532int
6533iwx_mac_ctxt_cmd(struct iwx_softc *sc, struct iwx_node *in, uint32_t action,
  int assoc)
6535{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni = &in->in_ni;
struct iwx_mac_ctx_cmd cmd;
int active = (sc->sc_flags & IWX_FLAG_MAC_ACTIVE0x08);

if (action == IWX_FW_CTXT_ACTION_ADD1 && active)
panic("MAC already added");
if (action == IWX_FW_CTXT_ACTION_REMOVE3 && !active)
panic("MAC already removed");

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));

iwx_mac_ctxt_cmd_common(sc, in, &cmd, action);

if (action == IWX_FW_CTXT_ACTION_REMOVE3) {
return iwx_send_cmd_pdu(sc, IWX_MAC_CONTEXT_CMD0x28, 0,
    sizeof(cmd), &cmd);
}

if (ic->ic_opmode == IEEE80211_M_MONITOR) {
cmd.filter_flags |= htole32(IWX_MAC_FILTER_IN_PROMISC |((__uint32_t)((1 << 0) | (1 << 1) | (1 << 2
) | (1 << 6) | (1 << 12) | (1 << 11)))
    IWX_MAC_FILTER_IN_CONTROL_AND_MGMT |((__uint32_t)((1 << 0) | (1 << 1) | (1 << 2
) | (1 << 6) | (1 << 12) | (1 << 11)))
    IWX_MAC_FILTER_ACCEPT_GRP |((__uint32_t)((1 << 0) | (1 << 1) | (1 << 2
) | (1 << 6) | (1 << 12) | (1 << 11)))
    IWX_MAC_FILTER_IN_BEACON |((__uint32_t)((1 << 0) | (1 << 1) | (1 << 2
) | (1 << 6) | (1 << 12) | (1 << 11)))
    IWX_MAC_FILTER_IN_PROBE_REQUEST |((__uint32_t)((1 << 0) | (1 << 1) | (1 << 2
) | (1 << 6) | (1 << 12) | (1 << 11)))
    IWX_MAC_FILTER_IN_CRC32)((__uint32_t)((1 << 0) | (1 << 1) | (1 << 2
) | (1 << 6) | (1 << 12) | (1 << 11)));
} else if (!assoc || !ni->ni_associd || !ni->ni_dtimperiod)
/* 
 * Allow beacons to pass through as long as we are not
 * associated or we do not have dtim period information.
 */
cmd.filter_flags |= htole32(IWX_MAC_FILTER_IN_BEACON)((__uint32_t)((1 << 6)));
else
iwx_mac_ctxt_cmd_fill_sta(sc, in, &cmd.sta, assoc);

return iwx_send_cmd_pdu(sc, IWX_MAC_CONTEXT_CMD0x28, 0, sizeof(cmd), &cmd);
6572}

6574int
6575iwx_clear_statistics(struct iwx_softc *sc)
6576{
struct iwx_statistics_cmd scmd = {
.flags = htole32(IWX_STATISTICS_FLG_CLEAR)((__uint32_t)(0x01))
};
struct iwx_host_cmd cmd = {
.id = IWX_STATISTICS_CMD0x9c,
.len[0] = sizeof(scmd),
.data[0] = &scmd,
.flags = IWX_CMD_WANT_RESP,
.resp_pkt_len = sizeof(struct iwx_notif_statistics),
};
int err;

err = iwx_send_cmd(sc, &cmd);
if (err)
return err;

iwx_free_resp(sc, &cmd);
return 0;
6595}

6597void
6598iwx_add_task(struct iwx_softc *sc, struct taskq *taskq, struct task *task)
6599{
int s = splnet()splraise(0x7);

if (sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) {
splx(s)spllower(s);
return;
}

refcnt_take(&sc->task_refs);
if (!task_add(taskq, task))
refcnt_rele_wake(&sc->task_refs);
splx(s)spllower(s);
6611}

6613void
6614iwx_del_task(struct iwx_softc *sc, struct taskq *taskq, struct task *task)
6615{
if (task_del(taskq, task))
refcnt_rele(&sc->task_refs);
6618}

6620int
6621iwx_scan(struct iwx_softc *sc)
6622{
struct ieee80211com *ic = &sc->sc_ic;
struct ifnet *ifp = IC2IFP(ic)(&(ic)->ic_ac.ac_if);
int err;

if (sc->sc_flags & IWX_FLAG_BGSCAN0x200) {
err = iwx_scan_abort(sc);
if (err) {
	printf("%s: could not abort background scan\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname));
	return err;
}
}

err = iwx_umac_scan_v14(sc, 0);
if (err) {
printf("%s: could not initiate scan\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return err;
}

/*
* The current mode might have been fixed during association.
* Ensure all channels get scanned.
*/
if (IFM_MODE(ic->ic_media.ifm_cur->ifm_media)((ic->ic_media.ifm_cur->ifm_media) & 0x000000ff00000000ULL
) == IFM_AUTO0ULL)
ieee80211_setmode(ic, IEEE80211_MODE_AUTO);

sc->sc_flags |= IWX_FLAG_SCANNING0x04;
if (ifp->if_flags & IFF_DEBUG0x4)
printf("%s: %s -> %s\n", ifp->if_xname,
    ieee80211_state_name[ic->ic_state],
    ieee80211_state_name[IEEE80211_S_SCAN]);
if ((sc->sc_flags & IWX_FLAG_BGSCAN0x200) == 0) {
ieee80211_set_link_state(ic, LINK_STATE_DOWN2);
ieee80211_node_cleanup(ic, ic->ic_bss);
}
ic->ic_state = IEEE80211_S_SCAN;
wakeup(&ic->ic_state); /* wake iwx_init() */

return 0;
6662}

6664int
6665iwx_bgscan(struct ieee80211com *ic) 
6666{
struct iwx_softc *sc = IC2IFP(ic)(&(ic)->ic_ac.ac_if)->if_softc;
int err;

if (sc->sc_flags & IWX_FLAG_SCANNING0x04)
return 0;

err = iwx_umac_scan_v14(sc, 1);
if (err) {
printf("%s: could not initiate scan\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return err;
}

sc->sc_flags |= IWX_FLAG_BGSCAN0x200;
return 0;
6681}

6683void
6684iwx_bgscan_done(struct ieee80211com *ic,
  struct ieee80211_node_switch_bss_arg *arg, size_t arg_size)
6686{
struct iwx_softc *sc = ic->ic_softcic_ac.ac_if.if_softc;

free(sc->bgscan_unref_arg, M_DEVBUF2, sc->bgscan_unref_arg_size);
sc->bgscan_unref_arg = arg;
sc->bgscan_unref_arg_size = arg_size;
iwx_add_task(sc, sc->sc_nswq, &sc->bgscan_done_task);
6693}

6695void
6696iwx_bgscan_done_task(void *arg)
6697{
struct iwx_softc *sc = arg;
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_node *in = (void *)ic->ic_bss;
struct ieee80211_node *ni = &in->in_ni;
int tid, err = 0, s = splnet()splraise(0x7);

if ((sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) ||
   (ic->ic_flags & IEEE80211_F_BGSCAN0x08000000) == 0 ||
   ic->ic_state != IEEE80211_S_RUN) {
err = ENXIO6;
goto done;
}

err = iwx_flush_sta(sc, in);
if (err)
goto done;

for (tid = 0; tid < IWX_MAX_TID_COUNT8; tid++) {
int qid = IWX_FIRST_AGG_TX_QUEUE(1 + 1) + tid;

if (sc->aggqid[tid] == 0)
	continue;

err = iwx_disable_txq(sc, IWX_STATION_ID0, qid, tid);
if (err)
	goto done;
6724#if 0 /* disabled for now; we are going to DEAUTH soon anyway */
IEEE80211_SEND_ACTION(ic, ni, IEEE80211_CATEG_BA,((*(ic)->ic_send_mgmt)(ic, ni, 0xd0, (IEEE80211_CATEG_BA) <<
| (2), IEEE80211_REASON_AUTH_LEAVE << 16 | 0x01 <<
| tid))
    IEEE80211_ACTION_DELBA,((*(ic)->ic_send_mgmt)(ic, ni, 0xd0, (IEEE80211_CATEG_BA) <<
| (2), IEEE80211_REASON_AUTH_LEAVE << 16 | 0x01 <<
| tid))
    IEEE80211_REASON_AUTH_LEAVE << 16 |((*(ic)->ic_send_mgmt)(ic, ni, 0xd0, (IEEE80211_CATEG_BA) <<
| (2), IEEE80211_REASON_AUTH_LEAVE << 16 | 0x01 <<
| tid))
    IEEE80211_FC1_DIR_TODS << 8 | tid)((*(ic)->ic_send_mgmt)(ic, ni, 0xd0, (IEEE80211_CATEG_BA) <<
| (2), IEEE80211_REASON_AUTH_LEAVE << 16 | 0x01 <<
| tid));
6729#endif
ieee80211_node_tx_ba_clear(ni, tid);
sc->aggqid[tid] = 0;
}

/*
* Tx queues have been flushed and Tx agg has been stopped.
* Allow roaming to proceed.
*/
ni->ni_unref_arg = sc->bgscan_unref_arg;
ni->ni_unref_arg_size = sc->bgscan_unref_arg_size;
sc->bgscan_unref_arg = NULL((void *)0);
sc->bgscan_unref_arg_size = 0;
ieee80211_node_tx_stopped(ic, &in->in_ni);
6743done:
if (err) {
free(sc->bgscan_unref_arg, M_DEVBUF2, sc->bgscan_unref_arg_size);
sc->bgscan_unref_arg = NULL((void *)0);
sc->bgscan_unref_arg_size = 0;
if ((sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) == 0)
	task_add(systq, &sc->init_task);
}
refcnt_rele_wake(&sc->task_refs);
splx(s)spllower(s);
6753}

6755int
6756iwx_umac_scan_abort(struct iwx_softc *sc)
6757{
struct iwx_umac_scan_abort cmd = { 0 };

return iwx_send_cmd_pdu(sc,
   IWX_WIDE_ID(IWX_LONG_GROUP, IWX_SCAN_ABORT_UMAC)((0x1 << 8) | 0xe),
   0, sizeof(cmd), &cmd);
6763}

6765int
6766iwx_scan_abort(struct iwx_softc *sc)
6767{
int err;

err = iwx_umac_scan_abort(sc);
if (err == 0)
sc->sc_flags &= ~(IWX_FLAG_SCANNING0x04 | IWX_FLAG_BGSCAN0x200);
return err;
6774}

6776int
6777iwx_enable_mgmt_queue(struct iwx_softc *sc)
6778{
int err;

sc->first_data_qid = IWX_DQA_CMD_QUEUE0 + 1;

/*
* Non-QoS frames use the "MGMT" TID and queue.
* Other TIDs and data queues are reserved for QoS data frames.
*/
err = iwx_enable_txq(sc, IWX_STATION_ID0, sc->first_data_qid,
   IWX_MGMT_TID15, IWX_TX_RING_COUNT(256));
if (err) {
printf("%s: could not enable Tx queue %d (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), sc->first_data_qid, err);
return err;
}

return 0;
6796}

6798int
6799iwx_rs_rval2idx(uint8_t rval)
6800{
/* Firmware expects indices which match our 11g rate set. */
const struct ieee80211_rateset *rs = &ieee80211_std_rateset_11g;
int i;

for (i = 0; i < rs->rs_nrates; i++) {
if ((rs->rs_rates[i] & IEEE80211_RATE_VAL0x7f) == rval)
	return i;
}

return -1;
6811}

6813uint16_t
6814iwx_rs_ht_rates(struct iwx_softc *sc, struct ieee80211_node *ni, int rsidx)
6815{
struct ieee80211com *ic = &sc->sc_ic;
const struct ieee80211_ht_rateset *rs;
uint16_t htrates = 0;
int mcs;

rs = &ieee80211_std_ratesets_11n[rsidx];
for (mcs = rs->min_mcs; mcs <= rs->max_mcs; mcs++) {
if (!isset(ni->ni_rxmcs, mcs)((ni->ni_rxmcs)[(mcs)>>3] & (1<<((mcs)&
(8 -1)))) ||
    !isset(ic->ic_sup_mcs, mcs)((ic->ic_sup_mcs)[(mcs)>>3] & (1<<((mcs)&
(8 -1)))))
	continue;
htrates |= (1 << (mcs - rs->min_mcs));
}

return htrates;
6830}

6832int
6833iwx_rs_init(struct iwx_softc *sc, struct iwx_node *in)
6834{
struct ieee80211_node *ni = &in->in_ni;
struct ieee80211_rateset *rs = &ni->ni_rates;
struct iwx_tlc_config_cmd cfg_cmd;
uint32_t cmd_id;
int i;
size_t cmd_size = sizeof(cfg_cmd);

memset(&cfg_cmd, 0, sizeof(cfg_cmd))__builtin_memset((&cfg_cmd), (0), (sizeof(cfg_cmd)));

for (i = 0; i < rs->rs_nrates; i++) {
uint8_t rval = rs->rs_rates[i] & IEEE80211_RATE_VAL0x7f;
int idx = iwx_rs_rval2idx(rval);
if (idx == -1)
	return EINVAL22;
cfg_cmd.non_ht_rates |= (1 << idx);
}

if (ni->ni_flags & IEEE80211_NODE_HT0x0400) {
cfg_cmd.mode = IWX_TLC_MNG_MODE_HT;
cfg_cmd.ht_rates[IWX_TLC_NSS_10][IWX_TLC_HT_BW_NONE_1600] =
    iwx_rs_ht_rates(sc, ni, IEEE80211_HT_RATESET_SISO0);
cfg_cmd.ht_rates[IWX_TLC_NSS_21][IWX_TLC_HT_BW_NONE_1600] =
    iwx_rs_ht_rates(sc, ni, IEEE80211_HT_RATESET_MIMO22);
} else
cfg_cmd.mode = IWX_TLC_MNG_MODE_NON_HT;

cfg_cmd.sta_id = IWX_STATION_ID0;
if (in->in_phyctxt->sco == IEEE80211_HTOP0_SCO_SCA1 ||
   in->in_phyctxt->sco == IEEE80211_HTOP0_SCO_SCB3)
cfg_cmd.max_ch_width = IWX_TLC_MNG_CH_WIDTH_40MHZ;
else
cfg_cmd.max_ch_width = IWX_TLC_MNG_CH_WIDTH_20MHZ;
cfg_cmd.chains = IWX_TLC_MNG_CHAIN_A_MSK(1 << 0) | IWX_TLC_MNG_CHAIN_B_MSK(1 << 1);
cfg_cmd.max_mpdu_len = 3839;
if (ieee80211_node_supports_ht_sgi20(ni))
cfg_cmd.sgi_ch_width_supp = (1 << IWX_TLC_MNG_CH_WIDTH_20MHZ);
if (ieee80211_node_supports_ht_sgi40(ni))
cfg_cmd.sgi_ch_width_supp = (1 << IWX_TLC_MNG_CH_WIDTH_40MHZ);

cmd_id = iwx_cmd_id(IWX_TLC_MNG_CONFIG_CMD0x0f, IWX_DATA_PATH_GROUP0x5, 0);
return iwx_send_cmd_pdu(sc, cmd_id, IWX_CMD_ASYNC, cmd_size, &cfg_cmd);
6876}

6878void
6879iwx_rs_update(struct iwx_softc *sc, struct iwx_tlc_update_notif *notif)
6880{
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni = ic->ic_bss;
struct ieee80211_rateset *rs = &ni->ni_rates;
uint32_t rate_n_flags;
int i;

if (notif->sta_id != IWX_STATION_ID0 ||
   (le32toh(notif->flags)((__uint32_t)(notif->flags)) & IWX_TLC_NOTIF_FLAG_RATE(1 << 0)) == 0)
return;

rate_n_flags = le32toh(notif->rate)((__uint32_t)(notif->rate));
if (rate_n_flags & IWX_RATE_MCS_HT_MSK(1 << 8)) {
ni->ni_txmcs = (rate_n_flags &
    (IWX_RATE_HT_MCS_RATE_CODE_MSK0x7 |
    IWX_RATE_HT_MCS_NSS_MSK(3 << 3)));
} else {
uint8_t plcp = (rate_n_flags & IWX_RATE_LEGACY_RATE_MSK0xff);
uint8_t rval = 0;
for (i = IWX_RATE_1M_INDEX; i < nitems(iwx_rates)(sizeof((iwx_rates)) / sizeof((iwx_rates)[0])); i++) {
	if (iwx_rates[i].plcp == plcp) {
		rval = iwx_rates[i].rate;
		break;
	}
}
if (rval) {
	uint8_t rv;
	for (i = 0; i < rs->rs_nrates; i++) {
		rv = rs->rs_rates[i] & IEEE80211_RATE_VAL0x7f;
		if (rv == rval) {
			ni->ni_txrate = i;
			break;
		}
	}
}
}
6916}

6918int
6919iwx_phy_ctxt_update(struct iwx_softc *sc, struct iwx_phy_ctxt *phyctxt,
  struct ieee80211_channel *chan, uint8_t chains_static,
  uint8_t chains_dynamic, uint32_t apply_time, uint8_t sco)
6922{
uint16_t band_flags = (IEEE80211_CHAN_2GHZ0x0080 | IEEE80211_CHAN_5GHZ0x0100);
int err;

if (isset(sc->sc_enabled_capa,((sc->sc_enabled_capa)[(39)>>3] & (1<<((39
)&(8 -1))))
   IWX_UCODE_TLV_CAPA_BINDING_CDB_SUPPORT)((sc->sc_enabled_capa)[(39)>>3] & (1<<((39
)&(8 -1)))) &&
   (phyctxt->channel->ic_flags & band_flags) !=
   (chan->ic_flags & band_flags)) {
err = iwx_phy_ctxt_cmd(sc, phyctxt, chains_static,
    chains_dynamic, IWX_FW_CTXT_ACTION_REMOVE3, apply_time, sco);
if (err) {
	printf("%s: could not remove PHY context "
	    "(error %d)\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
	return err;
}
phyctxt->channel = chan;
err = iwx_phy_ctxt_cmd(sc, phyctxt, chains_static,
    chains_dynamic, IWX_FW_CTXT_ACTION_ADD1, apply_time, sco);
if (err) {
	printf("%s: could not add PHY context "
	    "(error %d)\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
	return err;
}
} else {
phyctxt->channel = chan;
err = iwx_phy_ctxt_cmd(sc, phyctxt, chains_static,
    chains_dynamic, IWX_FW_CTXT_ACTION_MODIFY2, apply_time, sco);
if (err) {
	printf("%s: could not update PHY context (error %d)\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
	return err;
}
}

phyctxt->sco = sco;
return 0;
6958}

6960int
6961iwx_auth(struct iwx_softc *sc)
6962{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_node *in = (void *)ic->ic_bss;
uint32_t duration;
int generation = sc->sc_generation, err;

splassert(IPL_NET)do { if (splassert_ctl > 0) { splassert_check(0x7, __func__
); } } while (0);

if (ic->ic_opmode == IEEE80211_M_MONITOR) {
err = iwx_phy_ctxt_update(sc, &sc->sc_phyctxt[0],
    ic->ic_ibss_chan, 1, 1, 0, IEEE80211_HTOP0_SCO_SCN0);
if (err)
	return err;
} else {
err = iwx_phy_ctxt_update(sc, &sc->sc_phyctxt[0],
    in->in_ni.ni_chan, 1, 1, 0, IEEE80211_HTOP0_SCO_SCN0);
if (err)
	return err;
}
in->in_phyctxt = &sc->sc_phyctxt[0];
IEEE80211_ADDR_COPY(in->in_macaddr, in->in_ni.ni_macaddr)__builtin_memcpy((in->in_macaddr), (in->in_ni.ni_macaddr
), (6)); 

err = iwx_mac_ctxt_cmd(sc, in, IWX_FW_CTXT_ACTION_ADD1, 0);
if (err) {
printf("%s: could not add MAC context (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
}
sc->sc_flags |= IWX_FLAG_MAC_ACTIVE0x08;

err = iwx_binding_cmd(sc, in, IWX_FW_CTXT_ACTION_ADD1);
if (err) {
printf("%s: could not add binding (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
goto rm_mac_ctxt;
}
sc->sc_flags |= IWX_FLAG_BINDING_ACTIVE0x10;

err = iwx_add_sta_cmd(sc, in, 0);
if (err) {
printf("%s: could not add sta (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
goto rm_binding;
}
sc->sc_flags |= IWX_FLAG_STA_ACTIVE0x20;

if (ic->ic_opmode == IEEE80211_M_MONITOR) {
err = iwx_enable_txq(sc, IWX_MONITOR_STA_ID2,
    IWX_DQA_INJECT_MONITOR_QUEUE2, IWX_MGMT_TID15,
    IWX_TX_RING_COUNT(256));
if (err)
	goto rm_sta;
return 0;
}

err = iwx_enable_mgmt_queue(sc);
if (err)
goto rm_sta;

err = iwx_clear_statistics(sc);
if (err)
goto rm_sta;

/*
* Prevent the FW from wandering off channel during association
* by "protecting" the session with a time event.
*/
if (in->in_ni.ni_intval)
duration = in->in_ni.ni_intval * 2;
else
duration = IEEE80211_DUR_TU1024; 
return iwx_schedule_session_protection(sc, in, duration);
7034rm_sta:
if (generation == sc->sc_generation) {
iwx_rm_sta_cmd(sc, in);
sc->sc_flags &= ~IWX_FLAG_STA_ACTIVE0x20;
}
7039rm_binding:
if (generation == sc->sc_generation) {
iwx_binding_cmd(sc, in, IWX_FW_CTXT_ACTION_REMOVE3);
sc->sc_flags &= ~IWX_FLAG_BINDING_ACTIVE0x10;
}
7044rm_mac_ctxt:
if (generation == sc->sc_generation) {
iwx_mac_ctxt_cmd(sc, in, IWX_FW_CTXT_ACTION_REMOVE3, 0);
sc->sc_flags &= ~IWX_FLAG_MAC_ACTIVE0x08;
}
return err;
7050}

7052int
7053iwx_deauth(struct iwx_softc *sc)
7054{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_node *in = (void *)ic->ic_bss;
int err;

splassert(IPL_NET)do { if (splassert_ctl > 0) { splassert_check(0x7, __func__
); } } while (0);

if (sc->sc_flags & IWX_FLAG_STA_ACTIVE0x20) {
err = iwx_rm_sta(sc, in);
if (err)
	return err;
sc->sc_flags &= ~IWX_FLAG_STA_ACTIVE0x20;
}

if (sc->sc_flags & IWX_FLAG_BINDING_ACTIVE0x10) {
err = iwx_binding_cmd(sc, in, IWX_FW_CTXT_ACTION_REMOVE3);
if (err) {
	printf("%s: could not remove binding (error %d)\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
	return err;
}
sc->sc_flags &= ~IWX_FLAG_BINDING_ACTIVE0x10;
}

if (sc->sc_flags & IWX_FLAG_MAC_ACTIVE0x08) {
err = iwx_mac_ctxt_cmd(sc, in, IWX_FW_CTXT_ACTION_REMOVE3, 0);
if (err) {
	printf("%s: could not remove MAC context (error %d)\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
	return err;
}
sc->sc_flags &= ~IWX_FLAG_MAC_ACTIVE0x08;
}

/* Move unused PHY context to a default channel. */
err = iwx_phy_ctxt_update(sc, &sc->sc_phyctxt[0],
   &ic->ic_channels[1], 1, 1, 0, IEEE80211_HTOP0_SCO_SCN0);
if (err)
return err;

return 0;
7095}

7097int
7098iwx_run(struct iwx_softc *sc)
7099{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_node *in = (void *)ic->ic_bss;
struct ieee80211_node *ni = &in->in_ni;
int err;

splassert(IPL_NET)do { if (splassert_ctl > 0) { splassert_check(0x7, __func__
); } } while (0);

if (ic->ic_opmode == IEEE80211_M_MONITOR) {
/* Add a MAC context and a sniffing STA. */
err = iwx_auth(sc);
if (err)
	return err;
}

/* Configure Rx chains for MIMO and configure 40 MHz channel. */
if (ic->ic_opmode == IEEE80211_M_MONITOR) {
uint8_t chains = iwx_mimo_enabled(sc) ? 2 : 1;
err = iwx_phy_ctxt_update(sc, in->in_phyctxt,
    in->in_phyctxt->channel, chains, chains,
    0, IEEE80211_HTOP0_SCO_SCN0);
if (err) {
	printf("%s: failed to update PHY\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
	return err;
}
} else if (ni->ni_flags & IEEE80211_NODE_HT0x0400) {
uint8_t chains = iwx_mimo_enabled(sc) ? 2 : 1;
uint8_t sco;
if (ieee80211_node_supports_ht_chan40(ni))
	sco = (ni->ni_htop0 & IEEE80211_HTOP0_SCO_MASK0x03);
else
	sco = IEEE80211_HTOP0_SCO_SCN0;
err = iwx_phy_ctxt_update(sc, in->in_phyctxt,
    in->in_phyctxt->channel, chains, chains,
    0, sco);
if (err) {
	printf("%s: failed to update PHY\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
	return err;
}
}

/* We have now been assigned an associd by the AP. */
err = iwx_mac_ctxt_cmd(sc, in, IWX_FW_CTXT_ACTION_MODIFY2, 1);
if (err) {
printf("%s: failed to update MAC\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return err;
}

err = iwx_sf_config(sc, IWX_SF_FULL_ON1);
if (err) {
printf("%s: could not set sf full on (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
}

err = iwx_allow_mcast(sc);
if (err) {
printf("%s: could not allow mcast (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
}

err = iwx_power_update_device(sc);
if (err) {
printf("%s: could not send power command (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
}
7167#ifdef notyet
/* 
* Disabled for now. Default beacon filter settings
* prevent net80211 from getting ERP and HT protection
* updates from beacons.
*/
err = iwx_enable_beacon_filter(sc, in);
if (err) {
printf("%s: could not enable beacon filter\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
return err;
}
7179#endif
err = iwx_power_mac_update_mode(sc, in);
if (err) {
printf("%s: could not update MAC power (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
}

if (ic->ic_opmode == IEEE80211_M_MONITOR)
return 0;

/* Start at lowest available bit-rate. Firmware will raise. */
in->in_ni.ni_txrate = 0;
in->in_ni.ni_txmcs = 0;

err = iwx_rs_init(sc, in);
if (err) {
printf("%s: could not init rate scaling (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
}

return 0;
7202}

7204int
7205iwx_run_stop(struct iwx_softc *sc)
7206{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_node *in = (void *)ic->ic_bss;
struct ieee80211_node *ni = &in->in_ni;
int err, i;

splassert(IPL_NET)do { if (splassert_ctl > 0) { splassert_check(0x7, __func__
); } } while (0);

err = iwx_flush_sta(sc, in);
if (err) {
printf("%s: could not flush Tx path (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
}

/*
* Stop Rx BA sessions now. We cannot rely on the BA task
* for this when moving out of RUN state since it runs in a
* separate thread.
* Note that in->in_ni (struct ieee80211_node) already represents
* our new access point in case we are roaming between APs.
* This means we cannot rely on struct ieee802111_node to tell
* us which BA sessions exist.
*/
for (i = 0; i < nitems(sc->sc_rxba_data)(sizeof((sc->sc_rxba_data)) / sizeof((sc->sc_rxba_data)
[0])); i++) {
struct iwx_rxba_data *rxba = &sc->sc_rxba_data[i];
if (rxba->baid == IWX_RX_REORDER_DATA_INVALID_BAID0x7f)
	continue;
iwx_sta_rx_agg(sc, ni, rxba->tid, 0, 0, 0, 0);
}

err = iwx_sf_config(sc, IWX_SF_INIT_OFF3);
if (err)
return err;

err = iwx_disable_beacon_filter(sc);
if (err) {
printf("%s: could not disable beacon filter (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
}	

/* Mark station as disassociated. */
err = iwx_mac_ctxt_cmd(sc, in, IWX_FW_CTXT_ACTION_MODIFY2, 0);
if (err) {
printf("%s: failed to update MAC\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return err;
}

/* Reset Tx chains in case MIMO or 40 MHz channels were enabled. */
if (in->in_ni.ni_flags & IEEE80211_NODE_HT0x0400) {
err = iwx_phy_ctxt_update(sc, in->in_phyctxt,
   in->in_phyctxt->channel, 1, 1, 0, IEEE80211_HTOP0_SCO_SCN0);
if (err) {
	printf("%s: failed to update PHY\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
	return err;
}
}

return 0;
7266}

7268struct ieee80211_node *
7269iwx_node_alloc(struct ieee80211com *ic)
7270{
return malloc(sizeof (struct iwx_node), M_DEVBUF2, M_NOWAIT0x0002 | M_ZERO0x0008);
7272}

7274int
7275iwx_set_key(struct ieee80211com *ic, struct ieee80211_node *ni,
  struct ieee80211_key *k)
7277{
struct iwx_softc *sc = ic->ic_softcic_ac.ac_if.if_softc;
struct iwx_node *in = (void *)ni;
struct iwx_setkey_task_arg *a;
int err;

if (k->k_cipher != IEEE80211_CIPHER_CCMP) {
/* Fallback to software crypto for other ciphers. */
err = ieee80211_set_key(ic, ni, k);
if (!err && (k->k_flags & IEEE80211_KEY_GROUP0x00000001))
	in->in_flags |= IWX_NODE_FLAG_HAVE_GROUP_KEY0x02;
return err;
}

if (sc->setkey_nkeys >= nitems(sc->setkey_arg)(sizeof((sc->setkey_arg)) / sizeof((sc->setkey_arg)[0])
))
return ENOSPC28;

a = &sc->setkey_arg[sc->setkey_cur];
a->sta_id = IWX_STATION_ID0;
a->ni = ni;
a->k = k;
sc->setkey_cur = (sc->setkey_cur + 1) % nitems(sc->setkey_arg)(sizeof((sc->setkey_arg)) / sizeof((sc->setkey_arg)[0])
);
sc->setkey_nkeys++;
iwx_add_task(sc, systq, &sc->setkey_task);
return EBUSY16;
7302}

7304int
7305iwx_add_sta_key(struct iwx_softc *sc, int sta_id, struct ieee80211_node *ni,
  struct ieee80211_key *k)
7307{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_node *in = (void *)ni;
struct iwx_add_sta_key_cmd cmd;
uint32_t status;
const int want_keymask = (IWX_NODE_FLAG_HAVE_PAIRWISE_KEY0x01 |
   IWX_NODE_FLAG_HAVE_GROUP_KEY0x02);
int err;

/*
* Keys are stored in 'ni' so 'k' is valid if 'ni' is valid.
* Currently we only implement station mode where 'ni' is always
* ic->ic_bss so there is no need to validate arguments beyond this:
*/
KASSERT(ni == ic->ic_bss)((ni == ic->ic_bss) ? (void)0 : __assert("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c"
, 7321, "ni == ic->ic_bss"));

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));

cmd.common.key_flags = htole16(IWX_STA_KEY_FLG_CCM |((__uint16_t)((2 << 0) | (1 << 3) | ((k->k_id <<
 8) & (3 << 8))))
   IWX_STA_KEY_FLG_WEP_KEY_MAP |((__uint16_t)((2 << 0) | (1 << 3) | ((k->k_id <<
 8) & (3 << 8))))
   ((k->k_id << IWX_STA_KEY_FLG_KEYID_POS) &((__uint16_t)((2 << 0) | (1 << 3) | ((k->k_id <<
 8) & (3 << 8))))
   IWX_STA_KEY_FLG_KEYID_MSK))((__uint16_t)((2 << 0) | (1 << 3) | ((k->k_id <<
 8) & (3 << 8))));
if (k->k_flags & IEEE80211_KEY_GROUP0x00000001) {
cmd.common.key_offset = 1;
cmd.common.key_flags |= htole16(IWX_STA_KEY_MULTICAST)((__uint16_t)((1 << 14)));
} else
cmd.common.key_offset = 0;

memcpy(cmd.common.key, k->k_key, MIN(sizeof(cmd.common.key), k->k_len))__builtin_memcpy((cmd.common.key), (k->k_key), ((((sizeof(
cmd.common.key))<(k->k_len))?(sizeof(cmd.common.key)):(
k->k_len))));
cmd.common.sta_id = sta_id;

cmd.transmit_seq_cnt = htole64(k->k_tsc)((__uint64_t)(k->k_tsc));

status = IWX_ADD_STA_SUCCESS0x1;
err = iwx_send_cmd_pdu_status(sc, IWX_ADD_STA_KEY0x17, sizeof(cmd), &cmd,
   &status);
if (sc->sc_flags & IWX_FLAG_SHUTDOWN0x100)
return ECANCELED88;
if (!err && (status & IWX_ADD_STA_STATUS_MASK0xFF) != IWX_ADD_STA_SUCCESS0x1)
err = EIO5;
if (err) {
IEEE80211_SEND_MGMT(ic, ni, IEEE80211_FC0_SUBTYPE_DEAUTH,((*(ic)->ic_send_mgmt)(ic, ni, 0xc0, IEEE80211_REASON_AUTH_LEAVE
, 0))
    IEEE80211_REASON_AUTH_LEAVE)((*(ic)->ic_send_mgmt)(ic, ni, 0xc0, IEEE80211_REASON_AUTH_LEAVE
, 0));
ieee80211_new_state(ic, IEEE80211_S_SCAN, -1)(((ic)->ic_newstate)((ic), (IEEE80211_S_SCAN), (-1)));
return err;
}

if (k->k_flags & IEEE80211_KEY_GROUP0x00000001)
in->in_flags |= IWX_NODE_FLAG_HAVE_GROUP_KEY0x02;
else
in->in_flags |= IWX_NODE_FLAG_HAVE_PAIRWISE_KEY0x01;

if ((in->in_flags & want_keymask) == want_keymask) {
DPRINTF(("marking port %s valid\n",do { ; } while (0)
    ether_sprintf(ni->ni_macaddr)))do { ; } while (0);
ni->ni_port_valid = 1;
ieee80211_set_link_state(ic, LINK_STATE_UP4);
}

return 0;
7367}

7369void
7370iwx_setkey_task(void *arg)
7371{
struct iwx_softc *sc = arg;
struct iwx_setkey_task_arg *a;
int err = 0, s = splnet()splraise(0x7);

while (sc->setkey_nkeys > 0) {
if (err || (sc->sc_flags & IWX_FLAG_SHUTDOWN0x100))
	break;
a = &sc->setkey_arg[sc->setkey_tail];
err = iwx_add_sta_key(sc, a->sta_id, a->ni, a->k);
a->sta_id = 0;
a->ni = NULL((void *)0);
a->k = NULL((void *)0);
sc->setkey_tail = (sc->setkey_tail + 1) %
    nitems(sc->setkey_arg)(sizeof((sc->setkey_arg)) / sizeof((sc->setkey_arg)[0])
);
sc->setkey_nkeys--;
}

refcnt_rele_wake(&sc->task_refs);
splx(s)spllower(s);
7391}

7393void
7394iwx_delete_key(struct ieee80211com *ic, struct ieee80211_node *ni,
  struct ieee80211_key *k)
7396{
struct iwx_softc *sc = ic->ic_softcic_ac.ac_if.if_softc;
struct iwx_add_sta_key_cmd cmd;

if (k->k_cipher != IEEE80211_CIPHER_CCMP) {
/* Fallback to software crypto for other ciphers. */
              ieee80211_delete_key(ic, ni, k);
return;
}

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));

cmd.common.key_flags = htole16(IWX_STA_KEY_NOT_VALID |((__uint16_t)((1 << 11) | (0 << 0) | (1 << 3
) | ((k->k_id << 8) & (3 << 8))))
   IWX_STA_KEY_FLG_NO_ENC | IWX_STA_KEY_FLG_WEP_KEY_MAP |((__uint16_t)((1 << 11) | (0 << 0) | (1 << 3
) | ((k->k_id << 8) & (3 << 8))))
   ((k->k_id << IWX_STA_KEY_FLG_KEYID_POS) &((__uint16_t)((1 << 11) | (0 << 0) | (1 << 3
) | ((k->k_id << 8) & (3 << 8))))
   IWX_STA_KEY_FLG_KEYID_MSK))((__uint16_t)((1 << 11) | (0 << 0) | (1 << 3
) | ((k->k_id << 8) & (3 << 8))));
memcpy(cmd.common.key, k->k_key, MIN(sizeof(cmd.common.key), k->k_len))__builtin_memcpy((cmd.common.key), (k->k_key), ((((sizeof(
cmd.common.key))<(k->k_len))?(sizeof(cmd.common.key)):(
k->k_len))));
if (k->k_flags & IEEE80211_KEY_GROUP0x00000001)
cmd.common.key_offset = 1;
else
cmd.common.key_offset = 0;
cmd.common.sta_id = IWX_STATION_ID0;

iwx_send_cmd_pdu(sc, IWX_ADD_STA_KEY0x17, IWX_CMD_ASYNC, sizeof(cmd), &cmd);
7420}

7422int
7423iwx_media_change(struct ifnet *ifp)
7424{
struct iwx_softc *sc = ifp->if_softc;
struct ieee80211com *ic = &sc->sc_ic;
uint8_t rate, ridx;
int err;

err = ieee80211_media_change(ifp);
if (err != ENETRESET52)
return err;

if (ic->ic_fixed_mcs != -1)
sc->sc_fixed_ridx = iwx_mcs2ridx[ic->ic_fixed_mcs];
else if (ic->ic_fixed_rate != -1) {
rate = ic->ic_sup_rates[ic->ic_curmode].
    rs_rates[ic->ic_fixed_rate] & IEEE80211_RATE_VAL0x7f;
/* Map 802.11 rate to HW rate index. */
for (ridx = 0; ridx <= IWX_RIDX_MAX((sizeof((iwx_rates)) / sizeof((iwx_rates)[0]))-1); ridx++)
	if (iwx_rates[ridx].rate == rate)
		break;
sc->sc_fixed_ridx = ridx;
}

if ((ifp->if_flags & (IFF_UP0x1 | IFF_RUNNING0x40)) ==
   (IFF_UP0x1 | IFF_RUNNING0x40)) {
iwx_stop(ifp);
err = iwx_init(ifp);
}
return err;
7452}

7454void
7455iwx_newstate_task(void *psc)
7456{
struct iwx_softc *sc = (struct iwx_softc *)psc;
struct ieee80211com *ic = &sc->sc_ic;
enum ieee80211_state nstate = sc->ns_nstate;
enum ieee80211_state ostate = ic->ic_state;
int arg = sc->ns_arg;
int err = 0, s = splnet()splraise(0x7);

if (sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) {
/* iwx_stop() is waiting for us. */
refcnt_rele_wake(&sc->task_refs);
splx(s)spllower(s);
return;
}

if (ostate == IEEE80211_S_SCAN) {
if (nstate == ostate) {
	if (sc->sc_flags & IWX_FLAG_SCANNING0x04) {
		refcnt_rele_wake(&sc->task_refs);
		splx(s)spllower(s);
		return;
	}
	/* Firmware is no longer scanning. Do another scan. */
	goto next_scan;
}
}

if (nstate <= ostate) {
switch (ostate) {
case IEEE80211_S_RUN:
	err = iwx_run_stop(sc);
	if (err)
		goto out;
	/* FALLTHROUGH */
case IEEE80211_S_ASSOC:
case IEEE80211_S_AUTH:
	if (nstate <= IEEE80211_S_AUTH) {
		err = iwx_deauth(sc);
		if (err)
			goto out;
	}
	/* FALLTHROUGH */
case IEEE80211_S_SCAN:
case IEEE80211_S_INIT:
	break;
}

/* Die now if iwx_stop() was called while we were sleeping. */
if (sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) {
	refcnt_rele_wake(&sc->task_refs);
	splx(s)spllower(s);
	return;
}
}

switch (nstate) {
case IEEE80211_S_INIT:
break;

case IEEE80211_S_SCAN:
7516next_scan:
err = iwx_scan(sc);
if (err)
	break;
refcnt_rele_wake(&sc->task_refs);
splx(s)spllower(s);
return;

case IEEE80211_S_AUTH:
err = iwx_auth(sc);
break;

case IEEE80211_S_ASSOC:
break;

case IEEE80211_S_RUN:
err = iwx_run(sc);
break;
}

7536out:
if ((sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) == 0) {
if (err)
	task_add(systq, &sc->init_task);
else
	sc->sc_newstate(ic, nstate, arg);
}
refcnt_rele_wake(&sc->task_refs);
splx(s)spllower(s);
7545}

7547int
7548iwx_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
7549{
struct ifnet *ifp = IC2IFP(ic)(&(ic)->ic_ac.ac_if);
struct iwx_softc *sc = ifp->if_softc;

/*
* Prevent attempts to transition towards the same state, unless
* we are scanning in which case a SCAN -> SCAN transition
* triggers another scan iteration. And AUTH -> AUTH is needed
* to support band-steering.
*/
if (sc->ns_nstate == nstate && nstate != IEEE80211_S_SCAN &&
   nstate != IEEE80211_S_AUTH)
return 0;

if (ic->ic_state == IEEE80211_S_RUN) {
iwx_del_task(sc, systq, &sc->ba_task);
iwx_del_task(sc, systq, &sc->setkey_task);
memset(sc->setkey_arg, 0, sizeof(sc->setkey_arg))__builtin_memset((sc->setkey_arg), (0), (sizeof(sc->setkey_arg
)));
sc->setkey_cur = sc->setkey_tail = sc->setkey_nkeys = 0;
iwx_del_task(sc, systq, &sc->mac_ctxt_task);
iwx_del_task(sc, systq, &sc->phy_ctxt_task);
iwx_del_task(sc, systq, &sc->bgscan_done_task);
}

sc->ns_nstate = nstate;
sc->ns_arg = arg;

iwx_add_task(sc, sc->sc_nswq, &sc->newstate_task);

return 0;
7579}

7581void
7582iwx_endscan(struct iwx_softc *sc)
7583{
struct ieee80211com *ic = &sc->sc_ic;

if ((sc->sc_flags & (IWX_FLAG_SCANNING0x04 | IWX_FLAG_BGSCAN0x200)) == 0)
return;

sc->sc_flags &= ~(IWX_FLAG_SCANNING0x04 | IWX_FLAG_BGSCAN0x200);
ieee80211_end_scan(&ic->ic_ific_ac.ac_if);
7591}

7593/*
* Aging and idle timeouts for the different possible scenarios
* in default configuration
*/
7597static const uint32_t
7598iwx_sf_full_timeout_def[IWX_SF_NUM_SCENARIO5][IWX_SF_NUM_TIMEOUT_TYPES2] = {
{
htole32(IWX_SF_SINGLE_UNICAST_AGING_TIMER_DEF)((__uint32_t)(400)),
htole32(IWX_SF_SINGLE_UNICAST_IDLE_TIMER_DEF)((__uint32_t)(160))
},
{
htole32(IWX_SF_AGG_UNICAST_AGING_TIMER_DEF)((__uint32_t)(400)),
htole32(IWX_SF_AGG_UNICAST_IDLE_TIMER_DEF)((__uint32_t)(160))
},
{
htole32(IWX_SF_MCAST_AGING_TIMER_DEF)((__uint32_t)(400)),
htole32(IWX_SF_MCAST_IDLE_TIMER_DEF)((__uint32_t)(160))
},
{
htole32(IWX_SF_BA_AGING_TIMER_DEF)((__uint32_t)(400)),
htole32(IWX_SF_BA_IDLE_TIMER_DEF)((__uint32_t)(160))
},
{
htole32(IWX_SF_TX_RE_AGING_TIMER_DEF)((__uint32_t)(400)),
htole32(IWX_SF_TX_RE_IDLE_TIMER_DEF)((__uint32_t)(160))
},
7619};

7621/*
* Aging and idle timeouts for the different possible scenarios
* in single BSS MAC configuration.
*/
7625static const uint32_t
7626iwx_sf_full_timeout[IWX_SF_NUM_SCENARIO5][IWX_SF_NUM_TIMEOUT_TYPES2] = {
{
htole32(IWX_SF_SINGLE_UNICAST_AGING_TIMER)((__uint32_t)(2016)),
htole32(IWX_SF_SINGLE_UNICAST_IDLE_TIMER)((__uint32_t)(320))
},
{
htole32(IWX_SF_AGG_UNICAST_AGING_TIMER)((__uint32_t)(2016)),
htole32(IWX_SF_AGG_UNICAST_IDLE_TIMER)((__uint32_t)(320))
},
{
htole32(IWX_SF_MCAST_AGING_TIMER)((__uint32_t)(10016)),
htole32(IWX_SF_MCAST_IDLE_TIMER)((__uint32_t)(2016))
},
{
htole32(IWX_SF_BA_AGING_TIMER)((__uint32_t)(2016)),
htole32(IWX_SF_BA_IDLE_TIMER)((__uint32_t)(320))
},
{
htole32(IWX_SF_TX_RE_AGING_TIMER)((__uint32_t)(2016)),
htole32(IWX_SF_TX_RE_IDLE_TIMER)((__uint32_t)(320))
},
7647};

7649void
7650iwx_fill_sf_command(struct iwx_softc *sc, struct iwx_sf_cfg_cmd *sf_cmd,
  struct ieee80211_node *ni)
7652{
int i, j, watermark;

sf_cmd->watermark[IWX_SF_LONG_DELAY_ON0] = htole32(IWX_SF_W_MARK_SCAN)((__uint32_t)(4096));

/*
* If we are in association flow - check antenna configuration
* capabilities of the AP station, and choose the watermark accordingly.
*/
if (ni) {
if (ni->ni_flags & IEEE80211_NODE_HT0x0400) {
	if (ni->ni_rxmcs[1] != 0)
		watermark = IWX_SF_W_MARK_MIMO28192;
	else
		watermark = IWX_SF_W_MARK_SISO4096;
} else {
	watermark = IWX_SF_W_MARK_LEGACY4096;
}
/* default watermark value for unassociated mode. */
} else {
watermark = IWX_SF_W_MARK_MIMO28192;
}
sf_cmd->watermark[IWX_SF_FULL_ON1] = htole32(watermark)((__uint32_t)(watermark));

for (i = 0; i < IWX_SF_NUM_SCENARIO5; i++) {
for (j = 0; j < IWX_SF_NUM_TIMEOUT_TYPES2; j++) {
	sf_cmd->long_delay_timeouts[i][j] =
			htole32(IWX_SF_LONG_DELAY_AGING_TIMER)((__uint32_t)(1000000));
}
}

if (ni) {
memcpy(sf_cmd->full_on_timeouts, iwx_sf_full_timeout,__builtin_memcpy((sf_cmd->full_on_timeouts), (iwx_sf_full_timeout
), (sizeof(iwx_sf_full_timeout)))
       sizeof(iwx_sf_full_timeout))__builtin_memcpy((sf_cmd->full_on_timeouts), (iwx_sf_full_timeout
), (sizeof(iwx_sf_full_timeout)));
} else {
memcpy(sf_cmd->full_on_timeouts, iwx_sf_full_timeout_def,__builtin_memcpy((sf_cmd->full_on_timeouts), (iwx_sf_full_timeout_def
), (sizeof(iwx_sf_full_timeout_def)))
       sizeof(iwx_sf_full_timeout_def))__builtin_memcpy((sf_cmd->full_on_timeouts), (iwx_sf_full_timeout_def
), (sizeof(iwx_sf_full_timeout_def)));
}

7691}

7693int
7694iwx_sf_config(struct iwx_softc *sc, int new_state)
7695{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_sf_cfg_cmd sf_cmd = {
.state = htole32(new_state)((__uint32_t)(new_state)),
};
int err = 0;

switch (new_state) {
case IWX_SF_UNINIT2:
case IWX_SF_INIT_OFF3:
iwx_fill_sf_command(sc, &sf_cmd, NULL((void *)0));
break;
case IWX_SF_FULL_ON1:
iwx_fill_sf_command(sc, &sf_cmd, ic->ic_bss);
break;
default:
return EINVAL22;
}

err = iwx_send_cmd_pdu(sc, IWX_REPLY_SF_CFG_CMD0xd1, IWX_CMD_ASYNC,
		   sizeof(sf_cmd), &sf_cmd);
return err;
7717}

7719int
7720iwx_send_bt_init_conf(struct iwx_softc *sc)
7721{
struct iwx_bt_coex_cmd bt_cmd;

bt_cmd.mode = htole32(IWX_BT_COEX_WIFI)((__uint32_t)(0x3));
bt_cmd.enabled_modules = 0;

return iwx_send_cmd_pdu(sc, IWX_BT_CONFIG0x9b, 0, sizeof(bt_cmd),
   &bt_cmd);
7729}

7731int
7732iwx_send_soc_conf(struct iwx_softc *sc)
7733{
struct iwx_soc_configuration_cmd cmd;
int err;
uint32_t cmd_id, flags = 0;

memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));

/*
* In VER_1 of this command, the discrete value is considered
* an integer; In VER_2, it's a bitmask.  Since we have only 2
* values in VER_1, this is backwards-compatible with VER_2,
* as long as we don't set any other flag bits.
*/
if (!sc->sc_integrated) { /* VER_1 */
flags = IWX_SOC_CONFIG_CMD_FLAGS_DISCRETE(1 << 0);
} else { /* VER_2 */
uint8_t scan_cmd_ver;
if (sc->sc_ltr_delay != IWX_SOC_FLAGS_LTR_APPLY_DELAY_NONE0)
	flags |= (sc->sc_ltr_delay &
	    IWX_SOC_FLAGS_LTR_APPLY_DELAY_MASK0xc);
scan_cmd_ver = iwx_lookup_cmd_ver(sc, IWX_LONG_GROUP0x1,
    IWX_SCAN_REQ_UMAC0xd);
if (scan_cmd_ver != IWX_FW_CMD_VER_UNKNOWN99 &&
    scan_cmd_ver >= 2 && sc->sc_low_latency_xtal)
	flags |= IWX_SOC_CONFIG_CMD_FLAGS_LOW_LATENCY(1 << 1);
}
cmd.flags = htole32(flags)((__uint32_t)(flags));

cmd.latency = htole32(sc->sc_xtal_latency)((__uint32_t)(sc->sc_xtal_latency));

cmd_id = iwx_cmd_id(IWX_SOC_CONFIGURATION_CMD0x01, IWX_SYSTEM_GROUP0x2, 0);
err = iwx_send_cmd_pdu(sc, cmd_id, 0, sizeof(cmd), &cmd);
if (err)
printf("%s: failed to set soc latency: %d\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
7768}

7770int
7771iwx_send_update_mcc_cmd(struct iwx_softc *sc, const char *alpha2)
7772{
struct iwx_mcc_update_cmd mcc_cmd;
struct iwx_host_cmd hcmd = {
.id = IWX_MCC_UPDATE_CMD0xc8,
.flags = IWX_CMD_WANT_RESP,
.data = { &mcc_cmd },
};
struct iwx_rx_packet *pkt;
struct iwx_mcc_update_resp *resp;
size_t resp_len;
int err;

memset(&mcc_cmd, 0, sizeof(mcc_cmd))__builtin_memset((&mcc_cmd), (0), (sizeof(mcc_cmd)));
mcc_cmd.mcc = htole16(alpha2[0] << 8 | alpha2[1])((__uint16_t)(alpha2[0] << 8 | alpha2[1]));
if (isset(sc->sc_ucode_api, IWX_UCODE_TLV_API_WIFI_MCC_UPDATE)((sc->sc_ucode_api)[(9)>>3] & (1<<((9)&
(8 -1)))) ||
   isset(sc->sc_enabled_capa, IWX_UCODE_TLV_CAPA_LAR_MULTI_MCC)((sc->sc_enabled_capa)[(29)>>3] & (1<<((29
)&(8 -1)))))
mcc_cmd.source_id = IWX_MCC_SOURCE_GET_CURRENT0x10;
else
mcc_cmd.source_id = IWX_MCC_SOURCE_OLD_FW0;

hcmd.len[0] = sizeof(struct iwx_mcc_update_cmd);
hcmd.resp_pkt_len = IWX_CMD_RESP_MAX(1 << 12);

err = iwx_send_cmd(sc, &hcmd);
if (err)
return err;

pkt = hcmd.resp_pkt;
if (!pkt || (pkt->hdr.flags & IWX_CMD_FAILED_MSK0x40)) {
err = EIO5;
goto out;
}

resp_len = iwx_rx_packet_payload_len(pkt);
if (resp_len < sizeof(*resp)) {
err = EIO5;
goto out;
}

resp = (void *)pkt->data;
if (resp_len != sizeof(*resp) +
   resp->n_channels * sizeof(resp->channels[0])) {
err = EIO5;
goto out;
}

DPRINTF(("MCC status=0x%x mcc=0x%x cap=0x%x time=0x%x geo_info=0x%x source_id=0x%d n_channels=%u\n",do { ; } while (0)
   resp->status, resp->mcc, resp->cap, resp->time, resp->geo_info, resp->source_id, resp->n_channels))do { ; } while (0);

/* Update channel map for net80211 and our scan configuration. */
iwx_init_channel_map(sc, NULL((void *)0), resp->channels, resp->n_channels);

7824out:
iwx_free_resp(sc, &hcmd);

return err;
7828}

7830int
7831iwx_send_temp_report_ths_cmd(struct iwx_softc *sc)
7832{
struct iwx_temp_report_ths_cmd cmd;
int err;

/*
* In order to give responsibility for critical-temperature-kill
* and TX backoff to FW we need to send an empty temperature
* reporting command at init time.
*/
memset(&cmd, 0, sizeof(cmd))__builtin_memset((&cmd), (0), (sizeof(cmd)));

err = iwx_send_cmd_pdu(sc,
   IWX_WIDE_ID(IWX_PHY_OPS_GROUP, IWX_TEMP_REPORTING_THRESHOLDS_CMD)((0x4 << 8) | 0x04),
   0, sizeof(cmd), &cmd);
if (err)
printf("%s: TEMP_REPORT_THS_CMD command failed (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);

return err;
7851}

7853int
7854iwx_init_hw(struct iwx_softc *sc)
7855{
struct ieee80211com *ic = &sc->sc_ic;
int err, i;

err = iwx_run_init_mvm_ucode(sc, 0);
if (err)
return err;

if (!iwx_nic_lock(sc))
return EBUSY16;

err = iwx_send_tx_ant_cfg(sc, iwx_fw_valid_tx_ant(sc));
if (err) {
printf("%s: could not init tx ant config (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
goto err;
}

if (sc->sc_tx_with_siso_diversity) {
err = iwx_send_phy_cfg_cmd(sc);
if (err) {
	printf("%s: could not send phy config (error %d)\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
	goto err;
}
}

err = iwx_send_bt_init_conf(sc);
if (err) {
printf("%s: could not init bt coex (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
return err;
}

err = iwx_send_soc_conf(sc);
if (err)
return err;

if (isset(sc->sc_enabled_capa, IWX_UCODE_TLV_CAPA_DQA_SUPPORT)((sc->sc_enabled_capa)[(12)>>3] & (1<<((12
)&(8 -1))))) {
err = iwx_send_dqa_cmd(sc);
if (err)
	return err;
}

for (i = 0; i < IWX_NUM_PHY_CTX3; i++) {
/*
 * The channel used here isn't relevant as it's
 * going to be overwritten in the other flows.
 * For now use the first channel we have.
 */
sc->sc_phyctxt[i].id = i;
sc->sc_phyctxt[i].channel = &ic->ic_channels[1];
err = iwx_phy_ctxt_cmd(sc, &sc->sc_phyctxt[i], 1, 1,
    IWX_FW_CTXT_ACTION_ADD1, 0, IEEE80211_HTOP0_SCO_SCN0);
if (err) {
	printf("%s: could not add phy context %d (error %d)\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), i, err);
	goto err;
}
}

err = iwx_config_ltr(sc);
if (err) {
printf("%s: PCIe LTR configuration failed (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
}

if (isset(sc->sc_enabled_capa, IWX_UCODE_TLV_CAPA_CT_KILL_BY_FW)((sc->sc_enabled_capa)[(74)>>3] & (1<<((74
)&(8 -1))))) {
err = iwx_send_temp_report_ths_cmd(sc);
if (err)
	goto err;
}

err = iwx_power_update_device(sc);
if (err) {
printf("%s: could not send power command (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
goto err;
}

if (sc->sc_nvm.lar_enabled) {
err = iwx_send_update_mcc_cmd(sc, "ZZ");
if (err) {
	printf("%s: could not init LAR (error %d)\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
	goto err;
}
}

err = iwx_config_umac_scan_reduced(sc);
if (err) {
printf("%s: could not configure scan (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
goto err;
}

err = iwx_disable_beacon_filter(sc);
if (err) {
printf("%s: could not disable beacon filter (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);
goto err;
}

7958err:
iwx_nic_unlock(sc);
return err;
7961}

7963/* Allow multicast from our BSSID. */
7964int
7965iwx_allow_mcast(struct iwx_softc *sc)
7966{
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_node *in = (void *)ic->ic_bss;
struct iwx_mcast_filter_cmd *cmd;
size_t size;
int err;

size = roundup(sizeof(*cmd), 4)((((sizeof(*cmd))+((4)-1))/(4))*(4));
cmd = malloc(size, M_DEVBUF2, M_NOWAIT0x0002 | M_ZERO0x0008);
if (cmd == NULL((void *)0))
return ENOMEM12;
cmd->filter_own = 1;
cmd->port_id = 0;
cmd->count = 0;
cmd->pass_all = 1;
IEEE80211_ADDR_COPY(cmd->bssid, in->in_macaddr)__builtin_memcpy((cmd->bssid), (in->in_macaddr), (6));

err = iwx_send_cmd_pdu(sc, IWX_MCAST_FILTER_CMD0xd0,
   0, size, cmd);
free(cmd, M_DEVBUF2, size);
return err;
7987}

7989int
7990iwx_init(struct ifnet *ifp)
7991{
struct iwx_softc *sc = ifp->if_softc;
struct ieee80211com *ic = &sc->sc_ic;
int err, generation;

rw_assert_wrlock(&sc->ioctl_rwl);

generation = ++sc->sc_generation;

err = iwx_preinit(sc);
if (err)
return err;

err = iwx_start_hw(sc);
if (err) {
printf("%s: could not initialize hardware\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return err;
}

err = iwx_init_hw(sc);
if (err) {
if (generation == sc->sc_generation)
	iwx_stop_device(sc);
return err;
}

if (sc->sc_nvm.sku_cap_11n_enable)
iwx_setup_ht_rates(sc);

KASSERT(sc->task_refs.refs == 0)((sc->task_refs.refs == 0) ? (void)0 : __assert("diagnostic "
, "/usr/src/sys/dev/pci/if_iwx.c", 8020, "sc->task_refs.refs == 0"
));
refcnt_init(&sc->task_refs);
ifq_clr_oactive(&ifp->if_snd);
ifp->if_flags |= IFF_RUNNING0x40;

if (ic->ic_opmode == IEEE80211_M_MONITOR) {
ic->ic_bss->ni_chan = ic->ic_ibss_chan;
ieee80211_new_state(ic, IEEE80211_S_RUN, -1)(((ic)->ic_newstate)((ic), (IEEE80211_S_RUN), (-1)));
return 0;
}

ieee80211_begin_scan(ifp);

/* 
* ieee80211_begin_scan() ends up scheduling iwx_newstate_task().
* Wait until the transition to SCAN state has completed.
*/
do {
err = tsleep_nsec(&ic->ic_state, PCATCH0x100, "iwxinit",
    SEC_TO_NSEC(1));
if (generation != sc->sc_generation)
	return ENXIO6;
if (err) {
	iwx_stop(ifp);
	return err;
}
} while (ic->ic_state != IEEE80211_S_SCAN);

return 0;
8049}

8051void
8052iwx_start(struct ifnet *ifp)
8053{
struct iwx_softc *sc = ifp->if_softc;
struct ieee80211com *ic = &sc->sc_ic;
struct ieee80211_node *ni;
struct ether_header *eh;
struct mbuf *m;

if (!(ifp->if_flags & IFF_RUNNING0x40) || ifq_is_oactive(&ifp->if_snd))
return;

for (;;) {
/* why isn't this done per-queue? */
if (sc->qfullmsk != 0) {
	ifq_set_oactive(&ifp->if_snd);
	break;
}

/* Don't queue additional frames while flushing Tx queues. */
if (sc->sc_flags & IWX_FLAG_TXFLUSH0x400)
	break;

/* need to send management frames even if we're not RUNning */
m = mq_dequeue(&ic->ic_mgtq);
if (m) {
	ni = m->m_pkthdrM_dat.MH.MH_pkthdr.ph_cookie;
	goto sendit;
}

if (ic->ic_state != IEEE80211_S_RUN ||
    (ic->ic_xflags & IEEE80211_F_TX_MGMT_ONLY0x00000001))
	break;

m = ifq_dequeue(&ifp->if_snd);
if (!m)
	break;
if (m->m_lenm_hdr.mh_len < sizeof (*eh) &&
    (m = m_pullup(m, sizeof (*eh))) == NULL((void *)0)) {
	ifp->if_oerrorsif_data.ifi_oerrors++;
	continue;
}
8093#if NBPFILTER1 > 0
if (ifp->if_bpf != NULL((void *)0))
	bpf_mtap(ifp->if_bpf, m, BPF_DIRECTION_OUT(1 << 1));
8096#endif
if ((m = ieee80211_encap(ifp, m, &ni)) == NULL((void *)0)) {
	ifp->if_oerrorsif_data.ifi_oerrors++;
	continue;
}

sendit:
8103#if NBPFILTER1 > 0
if (ic->ic_rawbpf != NULL((void *)0))
	bpf_mtap(ic->ic_rawbpf, m, BPF_DIRECTION_OUT(1 << 1));
8106#endif
if (iwx_tx(sc, m, ni) != 0) {
	ieee80211_release_node(ic, ni);
	ifp->if_oerrorsif_data.ifi_oerrors++;
	continue;
}

if (ifp->if_flags & IFF_UP0x1)
	ifp->if_timer = 1;
}

return;
8118}

8120void
8121iwx_stop(struct ifnet *ifp)
8122{
struct iwx_softc *sc = ifp->if_softc;
struct ieee80211com *ic = &sc->sc_ic;
struct iwx_node *in = (void *)ic->ic_bss;
int i, s = splnet()splraise(0x7);

rw_assert_wrlock(&sc->ioctl_rwl);

sc->sc_flags |= IWX_FLAG_SHUTDOWN0x100; /* Disallow new tasks. */

/* Cancel scheduled tasks and let any stale tasks finish up. */
task_del(systq, &sc->init_task);
iwx_del_task(sc, sc->sc_nswq, &sc->newstate_task);
iwx_del_task(sc, systq, &sc->ba_task);
iwx_del_task(sc, systq, &sc->setkey_task);
memset(sc->setkey_arg, 0, sizeof(sc->setkey_arg))__builtin_memset((sc->setkey_arg), (0), (sizeof(sc->setkey_arg
)));
sc->setkey_cur = sc->setkey_tail = sc->setkey_nkeys = 0;
iwx_del_task(sc, systq, &sc->mac_ctxt_task);
iwx_del_task(sc, systq, &sc->phy_ctxt_task);
iwx_del_task(sc, systq, &sc->bgscan_done_task);
KASSERT(sc->task_refs.refs >= 1)((sc->task_refs.refs >= 1) ? (void)0 : __assert("diagnostic "
, "/usr/src/sys/dev/pci/if_iwx.c", 8142, "sc->task_refs.refs >= 1"
));
refcnt_finalize(&sc->task_refs, "iwxstop");

iwx_stop_device(sc);

free(sc->bgscan_unref_arg, M_DEVBUF2, sc->bgscan_unref_arg_size);
sc->bgscan_unref_arg = NULL((void *)0);
sc->bgscan_unref_arg_size = 0;

/* Reset soft state. */

sc->sc_generation++;
for (i = 0; i < nitems(sc->sc_cmd_resp_pkt)(sizeof((sc->sc_cmd_resp_pkt)) / sizeof((sc->sc_cmd_resp_pkt
)[0])); i++) {
free(sc->sc_cmd_resp_pkt[i], M_DEVBUF2, sc->sc_cmd_resp_len[i]);
sc->sc_cmd_resp_pkt[i] = NULL((void *)0);
sc->sc_cmd_resp_len[i] = 0;
}
ifp->if_flags &= ~IFF_RUNNING0x40;
ifq_clr_oactive(&ifp->if_snd);

in->in_phyctxt = NULL((void *)0);
in->in_flags = 0;
IEEE80211_ADDR_COPY(in->in_macaddr, etheranyaddr)__builtin_memcpy((in->in_macaddr), (etheranyaddr), (6));

sc->sc_flags &= ~(IWX_FLAG_SCANNING0x04 | IWX_FLAG_BGSCAN0x200);
sc->sc_flags &= ~IWX_FLAG_MAC_ACTIVE0x08;
sc->sc_flags &= ~IWX_FLAG_BINDING_ACTIVE0x10;
sc->sc_flags &= ~IWX_FLAG_STA_ACTIVE0x20;
sc->sc_flags &= ~IWX_FLAG_TE_ACTIVE0x40;
sc->sc_flags &= ~IWX_FLAG_HW_ERR0x80;
sc->sc_flags &= ~IWX_FLAG_SHUTDOWN0x100;
sc->sc_flags &= ~IWX_FLAG_TXFLUSH0x400;

sc->sc_rx_ba_sessions = 0;
sc->ba_rx.start_tidmask = 0;
sc->ba_rx.stop_tidmask = 0;
memset(sc->aggqid, 0, sizeof(sc->aggqid))__builtin_memset((sc->aggqid), (0), (sizeof(sc->aggqid)
));
sc->ba_tx.start_tidmask = 0;
sc->ba_tx.stop_tidmask = 0;

sc->sc_newstate(ic, IEEE80211_S_INIT, -1);
sc->ns_nstate = IEEE80211_S_INIT;

for (i = 0; i < nitems(sc->sc_rxba_data)(sizeof((sc->sc_rxba_data)) / sizeof((sc->sc_rxba_data)
[0])); i++) {
struct iwx_rxba_data *rxba = &sc->sc_rxba_data[i];
iwx_clear_reorder_buffer(sc, rxba);
}
memset(sc->sc_tx_timer, 0, sizeof(sc->sc_tx_timer))__builtin_memset((sc->sc_tx_timer), (0), (sizeof(sc->sc_tx_timer
)));
ifp->if_timer = 0;

splx(s)spllower(s);
8193}

8195void
8196iwx_watchdog(struct ifnet *ifp)
8197{
struct iwx_softc *sc = ifp->if_softc;
int i;

ifp->if_timer = 0;

/*
* We maintain a separate timer for each Tx queue because
* Tx aggregation queues can get "stuck" while other queues
* keep working. The Linux driver uses a similar workaround.
*/
for (i = 0; i < nitems(sc->sc_tx_timer)(sizeof((sc->sc_tx_timer)) / sizeof((sc->sc_tx_timer)[0
])); i++) {
if (sc->sc_tx_timer[i] > 0) {
	if (--sc->sc_tx_timer[i] == 0) {
		printf("%s: device timeout\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
		if (ifp->if_flags & IFF_DEBUG0x4) {
			iwx_nic_error(sc);
			iwx_dump_driver_status(sc);
		}
		if ((sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) == 0)
			task_add(systq, &sc->init_task);
		ifp->if_oerrorsif_data.ifi_oerrors++;
		return;
	}
	ifp->if_timer = 1;
}
}

ieee80211_watchdog(ifp);
8226}

8228int
8229iwx_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
8230{
struct iwx_softc *sc = ifp->if_softc;
int s, err = 0, generation = sc->sc_generation;

/*
* Prevent processes from entering this function while another
* process is tsleep'ing in it.
*/
err = rw_enter(&sc->ioctl_rwl, RW_WRITE0x0001UL | RW_INTR0x0010UL);
if (err == 0 && generation != sc->sc_generation) {
rw_exit(&sc->ioctl_rwl);
return ENXIO6;
}
if (err)
return err;
s = splnet()splraise(0x7);

switch (cmd) {
case SIOCSIFADDR((unsigned long)0x80000000 | ((sizeof(struct ifreq) & 0x1fff
) << 16) | ((('i')) << 8) | ((12))):
ifp->if_flags |= IFF_UP0x1;
/* FALLTHROUGH */
case SIOCSIFFLAGS((unsigned long)0x80000000 | ((sizeof(struct ifreq) & 0x1fff
) << 16) | ((('i')) << 8) | ((16))):
if (ifp->if_flags & IFF_UP0x1) {
	if (!(ifp->if_flags & IFF_RUNNING0x40)) {
		/* Force reload of firmware image from disk. */
		sc->sc_fw.fw_status = IWX_FW_STATUS_NONE0;
		err = iwx_init(ifp);
	}
} else {
	if (ifp->if_flags & IFF_RUNNING0x40)
		iwx_stop(ifp);
}
break;

default:
err = ieee80211_ioctl(ifp, cmd, data);
}

if (err == ENETRESET52) {
err = 0;
if ((ifp->if_flags & (IFF_UP0x1 | IFF_RUNNING0x40)) ==
    (IFF_UP0x1 | IFF_RUNNING0x40)) {
	iwx_stop(ifp);
	err = iwx_init(ifp);
}
}

splx(s)spllower(s);
rw_exit(&sc->ioctl_rwl);

return err;
8281}

8283/*
* Note: This structure is read from the device with IO accesses,
* and the reading already does the endian conversion. As it is
* read with uint32_t-sized accesses, any members with a different size
* need to be ordered correctly though!
*/
8289struct iwx_error_event_table {
uint32_t valid;		/* (nonzero) valid, (0) log is empty */
uint32_t error_id;		/* type of error */
uint32_t trm_hw_status0;	/* TRM HW status */
uint32_t trm_hw_status1;	/* TRM HW status */
uint32_t blink2;		/* branch link */
uint32_t ilink1;		/* interrupt link */
uint32_t ilink2;		/* interrupt link */
uint32_t data1;		/* error-specific data */
uint32_t data2;		/* error-specific data */
uint32_t data3;		/* error-specific data */
uint32_t bcon_time;		/* beacon timer */
uint32_t tsf_low;		/* network timestamp function timer */
uint32_t tsf_hi;		/* network timestamp function timer */
uint32_t gp1;		/* GP1 timer register */
uint32_t gp2;		/* GP2 timer register */
uint32_t fw_rev_type;	/* firmware revision type */
uint32_t major;		/* uCode version major */
uint32_t minor;		/* uCode version minor */
uint32_t hw_ver;		/* HW Silicon version */
uint32_t brd_ver;		/* HW board version */
uint32_t log_pc;		/* log program counter */
uint32_t frame_ptr;		/* frame pointer */
uint32_t stack_ptr;		/* stack pointer */
uint32_t hcmd;		/* last host command header */
uint32_t isr0;		/* isr status register LMPM_NIC_ISR0:
		 * rxtx_flag */
uint32_t isr1;		/* isr status register LMPM_NIC_ISR1:
		 * host_flag */
uint32_t isr2;		/* isr status register LMPM_NIC_ISR2:
		 * enc_flag */
uint32_t isr3;		/* isr status register LMPM_NIC_ISR3:
		 * time_flag */
uint32_t isr4;		/* isr status register LMPM_NIC_ISR4:
		 * wico interrupt */
uint32_t last_cmd_id;	/* last HCMD id handled by the firmware */
uint32_t wait_event;		/* wait event() caller address */
uint32_t l2p_control;	/* L2pControlField */
uint32_t l2p_duration;	/* L2pDurationField */
uint32_t l2p_mhvalid;	/* L2pMhValidBits */
uint32_t l2p_addr_match;	/* L2pAddrMatchStat */
uint32_t lmpm_pmg_sel;	/* indicate which clocks are turned on
		 * (LMPM_PMG_SEL) */
uint32_t u_timestamp;	/* indicate when the date and time of the
		 * compilation */
uint32_t flow_handler;	/* FH read/write pointers, RX credit */
8335} __packed__attribute__((__packed__)) /* LOG_ERROR_TABLE_API_S_VER_3 */;

8337/*
* UMAC error struct - relevant starting from family 8000 chip.
* Note: This structure is read from the device with IO accesses,
* and the reading already does the endian conversion. As it is
* read with u32-sized accesses, any members with a different size
* need to be ordered correctly though!
*/
8344struct iwx_umac_error_event_table {
uint32_t valid;		/* (nonzero) valid, (0) log is empty */
uint32_t error_id;	/* type of error */
uint32_t blink1;	/* branch link */
uint32_t blink2;	/* branch link */
uint32_t ilink1;	/* interrupt link */
uint32_t ilink2;	/* interrupt link */
uint32_t data1;		/* error-specific data */
uint32_t data2;		/* error-specific data */
uint32_t data3;		/* error-specific data */
uint32_t umac_major;
uint32_t umac_minor;
uint32_t frame_pointer;	/* core register 27*/
uint32_t stack_pointer;	/* core register 28 */
uint32_t cmd_header;	/* latest host cmd sent to UMAC */
uint32_t nic_isr_pref;	/* ISR status register */
8360} __packed__attribute__((__packed__));

8362#define ERROR_START_OFFSET(1 * sizeof(uint32_t))  (1 * sizeof(uint32_t))
8363#define ERROR_ELEM_SIZE(7 * sizeof(uint32_t))     (7 * sizeof(uint32_t))

8365void
8366iwx_nic_umac_error(struct iwx_softc *sc)
8367{
struct iwx_umac_error_event_table table;
uint32_t base;

base = sc->sc_uc.uc_umac_error_event_table;

if (base < 0x800000) {
printf("%s: Invalid error log pointer 0x%08x\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), base);
return;
}

if (iwx_read_mem(sc, base, &table, sizeof(table)/sizeof(uint32_t))) {
printf("%s: reading errlog failed\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return;
}

if (ERROR_START_OFFSET(1 * sizeof(uint32_t)) <= table.valid * ERROR_ELEM_SIZE(7 * sizeof(uint32_t))) {
printf("%s: Start UMAC Error Log Dump:\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
printf("%s: Status: 0x%x, count: %d\n", DEVNAME(sc)((sc)->sc_dev.dv_xname),
	sc->sc_flags, table.valid);
}

printf("%s: 0x%08X | %s\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.error_id,
iwx_desc_lookup(table.error_id));
printf("%s: 0x%08X | umac branchlink1\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.blink1);
printf("%s: 0x%08X | umac branchlink2\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.blink2);
printf("%s: 0x%08X | umac interruptlink1\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.ilink1);
printf("%s: 0x%08X | umac interruptlink2\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.ilink2);
printf("%s: 0x%08X | umac data1\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.data1);
printf("%s: 0x%08X | umac data2\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.data2);
printf("%s: 0x%08X | umac data3\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.data3);
printf("%s: 0x%08X | umac major\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.umac_major);
printf("%s: 0x%08X | umac minor\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.umac_minor);
printf("%s: 0x%08X | frame pointer\n", DEVNAME(sc)((sc)->sc_dev.dv_xname),
   table.frame_pointer);
printf("%s: 0x%08X | stack pointer\n", DEVNAME(sc)((sc)->sc_dev.dv_xname),
   table.stack_pointer);
printf("%s: 0x%08X | last host cmd\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.cmd_header);
printf("%s: 0x%08X | isr status reg\n", DEVNAME(sc)((sc)->sc_dev.dv_xname),
   table.nic_isr_pref);
8408}

8410#define IWX_FW_SYSASSERT_CPU_MASK0xf0000000 0xf0000000
8411static struct {
const char *name;
uint8_t num;
8414} advanced_lookup[] = {
{ "NMI_INTERRUPT_WDG", 0x34 },
{ "SYSASSERT", 0x35 },
{ "UCODE_VERSION_MISMATCH", 0x37 },
{ "BAD_COMMAND", 0x38 },
{ "BAD_COMMAND", 0x39 },
{ "NMI_INTERRUPT_DATA_ACTION_PT", 0x3C },
{ "FATAL_ERROR", 0x3D },
{ "NMI_TRM_HW_ERR", 0x46 },
{ "NMI_INTERRUPT_TRM", 0x4C },
{ "NMI_INTERRUPT_BREAK_POINT", 0x54 },
{ "NMI_INTERRUPT_WDG_RXF_FULL", 0x5C },
{ "NMI_INTERRUPT_WDG_NO_RBD_RXF_FULL", 0x64 },
{ "NMI_INTERRUPT_HOST", 0x66 },
{ "NMI_INTERRUPT_LMAC_FATAL", 0x70 },
{ "NMI_INTERRUPT_UMAC_FATAL", 0x71 },
{ "NMI_INTERRUPT_OTHER_LMAC_FATAL", 0x73 },
{ "NMI_INTERRUPT_ACTION_PT", 0x7C },
{ "NMI_INTERRUPT_UNKNOWN", 0x84 },
{ "NMI_INTERRUPT_INST_ACTION_PT", 0x86 },
{ "ADVANCED_SYSASSERT", 0 },
8435};

8437const char *
8438iwx_desc_lookup(uint32_t num)
8439{
int i;

for (i = 0; i < nitems(advanced_lookup)(sizeof((advanced_lookup)) / sizeof((advanced_lookup)[0])) - 1; i++)
if (advanced_lookup[i].num ==
    (num & ~IWX_FW_SYSASSERT_CPU_MASK0xf0000000))
	return advanced_lookup[i].name;

/* No entry matches 'num', so it is the last: ADVANCED_SYSASSERT */
return advanced_lookup[i].name;
8449}

8451/*
* Support for dumping the error log seemed like a good idea ...
* but it's mostly hex junk and the only sensible thing is the
* hw/ucode revision (which we know anyway).  Since it's here,
* I'll just leave it in, just in case e.g. the Intel guys want to
* help us decipher some "ADVANCED_SYSASSERT" later.
*/
8458void
8459iwx_nic_error(struct iwx_softc *sc)
8460{
struct iwx_error_event_table table;
uint32_t base;

printf("%s: dumping device error log\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
base = sc->sc_uc.uc_lmac_error_event_table[0];
if (base < 0x800000) {
printf("%s: Invalid error log pointer 0x%08x\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), base);
return;
}

if (iwx_read_mem(sc, base, &table, sizeof(table)/sizeof(uint32_t))) {
printf("%s: reading errlog failed\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return;
}

if (!table.valid) {
printf("%s: errlog not found, skipping\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return;
}

if (ERROR_START_OFFSET(1 * sizeof(uint32_t)) <= table.valid * ERROR_ELEM_SIZE(7 * sizeof(uint32_t))) {
printf("%s: Start Error Log Dump:\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
printf("%s: Status: 0x%x, count: %d\n", DEVNAME(sc)((sc)->sc_dev.dv_xname),
    sc->sc_flags, table.valid);
}

printf("%s: 0x%08X | %-28s\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.error_id,
   iwx_desc_lookup(table.error_id));
printf("%s: %08X | trm_hw_status0\n", DEVNAME(sc)((sc)->sc_dev.dv_xname),
   table.trm_hw_status0);
printf("%s: %08X | trm_hw_status1\n", DEVNAME(sc)((sc)->sc_dev.dv_xname),
   table.trm_hw_status1);
printf("%s: %08X | branchlink2\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.blink2);
printf("%s: %08X | interruptlink1\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.ilink1);
printf("%s: %08X | interruptlink2\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.ilink2);
printf("%s: %08X | data1\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.data1);
printf("%s: %08X | data2\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.data2);
printf("%s: %08X | data3\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.data3);
printf("%s: %08X | beacon time\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.bcon_time);
printf("%s: %08X | tsf low\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.tsf_low);
printf("%s: %08X | tsf hi\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.tsf_hi);
printf("%s: %08X | time gp1\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.gp1);
printf("%s: %08X | time gp2\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.gp2);
printf("%s: %08X | uCode revision type\n", DEVNAME(sc)((sc)->sc_dev.dv_xname),
   table.fw_rev_type);
printf("%s: %08X | uCode version major\n", DEVNAME(sc)((sc)->sc_dev.dv_xname),
   table.major);
printf("%s: %08X | uCode version minor\n", DEVNAME(sc)((sc)->sc_dev.dv_xname),
   table.minor);
printf("%s: %08X | hw version\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.hw_ver);
printf("%s: %08X | board version\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.brd_ver);
printf("%s: %08X | hcmd\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.hcmd);
printf("%s: %08X | isr0\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.isr0);
printf("%s: %08X | isr1\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.isr1);
printf("%s: %08X | isr2\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.isr2);
printf("%s: %08X | isr3\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.isr3);
printf("%s: %08X | isr4\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.isr4);
printf("%s: %08X | last cmd Id\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.last_cmd_id);
printf("%s: %08X | wait_event\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.wait_event);
printf("%s: %08X | l2p_control\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.l2p_control);
printf("%s: %08X | l2p_duration\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.l2p_duration);
printf("%s: %08X | l2p_mhvalid\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.l2p_mhvalid);
printf("%s: %08X | l2p_addr_match\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.l2p_addr_match);
printf("%s: %08X | lmpm_pmg_sel\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.lmpm_pmg_sel);
printf("%s: %08X | timestamp\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.u_timestamp);
printf("%s: %08X | flow_handler\n", DEVNAME(sc)((sc)->sc_dev.dv_xname), table.flow_handler);

if (sc->sc_uc.uc_umac_error_event_table)
iwx_nic_umac_error(sc);
8531}

8533void
8534iwx_dump_driver_status(struct iwx_softc *sc)
8535{
int i;

printf("driver status:\n");
for (i = 0; i < nitems(sc->txq)(sizeof((sc->txq)) / sizeof((sc->txq)[0])); i++) {
struct iwx_tx_ring *ring = &sc->txq[i];
printf("  tx ring %2d: qid=%-2d cur=%-3d "
    "queued=%-3d\n",
    i, ring->qid, ring->cur, ring->queued);
}
printf("  rx ring: cur=%d\n", sc->rxq.cur);
printf("  802.11 state %s\n",
   ieee80211_state_name[sc->sc_ic.ic_state]);
8548}

8550#define SYNC_RESP_STRUCT(_var_, _pkt_)do { (*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (
data->map), (sizeof(*(_pkt_))), (sizeof(*(_var_))), (0x02)
); _var_ = (void *)((_pkt_)+1); } while ( 0)					\
8551do {									\
bus_dmamap_sync(sc->sc_dmat, data->map, sizeof(*(_pkt_)),	\(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (sizeof(*(_pkt_))), (sizeof(*(_var_))), (0x02))
   sizeof(*(_var_)), BUS_DMASYNC_POSTREAD)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (sizeof(*(_pkt_))), (sizeof(*(_var_))), (0x02));			\
_var_ = (void *)((_pkt_)+1);					\
8555} while (/*CONSTCOND*/0)

8557#define SYNC_RESP_PTR(_ptr_, _len_, _pkt_)do { (*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (
data->map), (sizeof(*(_pkt_))), (sizeof(len)), (0x02)); _ptr_
 = (void *)((_pkt_)+1); } while ( 0)				\
8558do {									\
bus_dmamap_sync(sc->sc_dmat, data->map, sizeof(*(_pkt_)),	\(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (sizeof(*(_pkt_))), (sizeof(len)), (0x02))
   sizeof(len), BUS_DMASYNC_POSTREAD)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (sizeof(*(_pkt_))), (sizeof(len)), (0x02));				\
_ptr_ = (void *)((_pkt_)+1);					\
8562} while (/*CONSTCOND*/0)

8564int
8565iwx_rx_pkt_valid(struct iwx_rx_packet *pkt)
8566{
int qid, idx, code;

qid = pkt->hdr.qid & ~0x80;
idx = pkt->hdr.idx;
code = IWX_WIDE_ID(pkt->hdr.flags, pkt->hdr.code)((pkt->hdr.flags << 8) | pkt->hdr.code);

return (!(qid == 0 && idx == 0 && code == 0) &&
   pkt->len_n_flags != htole32(IWX_FH_RSCSR_FRAME_INVALID)((__uint32_t)(0x55550000)));
8575}

8577void
8578iwx_rx_pkt(struct iwx_softc *sc, struct iwx_rx_data *data, struct mbuf_list *ml)
8579{
struct ifnet *ifp = IC2IFP(&sc->sc_ic)(&(&sc->sc_ic)->ic_ac.ac_if);
struct iwx_rx_packet *pkt, *nextpkt;
uint32_t offset = 0, nextoff = 0, nmpdu = 0, len;
struct mbuf *m0, *m;
const size_t minsz = sizeof(pkt->len_n_flags) + sizeof(pkt->hdr);
int qid, idx, code, handled = 1;

bus_dmamap_sync(sc->sc_dmat, data->map, 0, IWX_RBUF_SIZE,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (4096), (0x02))
   BUS_DMASYNC_POSTREAD)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (4096), (0x02));

m0 = data->m;
while (m0 && offset + minsz < IWX_RBUF_SIZE4096) {
pkt = (struct iwx_rx_packet *)(m0->m_datam_hdr.mh_data + offset);
qid = pkt->hdr.qid;
idx = pkt->hdr.idx;

code = IWX_WIDE_ID(pkt->hdr.flags, pkt->hdr.code)((pkt->hdr.flags << 8) | pkt->hdr.code);

if (!iwx_rx_pkt_valid(pkt))
	break;

/*
 * XXX Intel inside (tm)
 * Any commands in the LONG_GROUP could actually be in the
 * LEGACY group. Firmware API versions >= 50 reject commands
 * in group 0, forcing us to use this hack.
 */
if (iwx_cmd_groupid(code) == IWX_LONG_GROUP0x1) {
	struct iwx_tx_ring *ring = &sc->txq[qid];
	struct iwx_tx_data *txdata = &ring->data[idx];
	if (txdata->flags & IWX_TXDATA_FLAG_CMD_IS_NARROW0x01)
		code = iwx_cmd_opcode(code);
}

len = sizeof(pkt->len_n_flags) + iwx_rx_packet_len(pkt);
if (len < minsz || len > (IWX_RBUF_SIZE4096 - offset))
	break;

if (code == IWX_REPLY_RX_MPDU_CMD0xc1 && ++nmpdu == 1) {
	/* Take mbuf m0 off the RX ring. */
	if (iwx_rx_addbuf(sc, IWX_RBUF_SIZE4096, sc->rxq.cur)) {
		ifp->if_ierrorsif_data.ifi_ierrors++;
		break;
	}
	KASSERT(data->m != m0)((data->m != m0) ? (void)0 : __assert("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c"
, 8624, "data->m != m0"));
}

switch (code) {
case IWX_REPLY_RX_PHY_CMD0xc0:
	iwx_rx_rx_phy_cmd(sc, pkt, data);
	break;

case IWX_REPLY_RX_MPDU_CMD0xc1: {
	size_t maxlen = IWX_RBUF_SIZE4096 - offset - minsz;
	nextoff = offset +
	    roundup(len, IWX_FH_RSCSR_FRAME_ALIGN)((((len)+((0x40)-1))/(0x40))*(0x40));
	nextpkt = (struct iwx_rx_packet *)
	    (m0->m_datam_hdr.mh_data + nextoff);
	if (nextoff + minsz >= IWX_RBUF_SIZE4096 ||
	    !iwx_rx_pkt_valid(nextpkt)) {
		/* No need to copy last frame in buffer. */
		if (offset > 0)
			m_adj(m0, offset);
		iwx_rx_mpdu_mq(sc, m0, pkt->data, maxlen, ml);
		m0 = NULL((void *)0); /* stack owns m0 now; abort loop */
	} else {
		/*
		 * Create an mbuf which points to the current
		 * packet. Always copy from offset zero to
		 * preserve m_pkthdr.
		 */
		m = m_copym(m0, 0, M_COPYALL1000000000, M_DONTWAIT0x0002);
		if (m == NULL((void *)0)) {
			ifp->if_ierrorsif_data.ifi_ierrors++;
			m_freem(m0);
			m0 = NULL((void *)0);
			break;
		}
		m_adj(m, offset);
		iwx_rx_mpdu_mq(sc, m, pkt->data, maxlen, ml);
	}
		break;
}

case IWX_BAR_FRAME_RELEASE0xc2:
	iwx_rx_bar_frame_release(sc, pkt, ml);
	break;

case IWX_TX_CMD0x1c:
	iwx_rx_tx_cmd(sc, pkt, data);
	break;

case IWX_BA_NOTIF0xc5:
	iwx_rx_compressed_ba(sc, pkt);
	break;

case IWX_MISSED_BEACONS_NOTIFICATION0xa2:
	iwx_rx_bmiss(sc, pkt, data);
	break;

case IWX_MFUART_LOAD_NOTIFICATION0xb1:
	break;

case IWX_ALIVE0x1: {
	struct iwx_alive_resp_v4 *resp4;
	struct iwx_alive_resp_v5 *resp5;

	DPRINTF(("%s: firmware alive\n", __func__))do { ; } while (0);
	sc->sc_uc.uc_ok = 0;

	/*
	 * For v5 and above, we can check the version, for older
	 * versions we need to check the size.
	 */
	 if (iwx_lookup_notif_ver(sc, IWX_LEGACY_GROUP0x0,
	    IWX_ALIVE0x1) == 5) {
		SYNC_RESP_STRUCT(resp5, pkt)do { (*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (
data->map), (sizeof(*(pkt))), (sizeof(*(resp5))), (0x02));
 resp5 = (void *)((pkt)+1); } while ( 0);
		if (iwx_rx_packet_payload_len(pkt) !=
		    sizeof(*resp5)) {
			sc->sc_uc.uc_intr = 1;
			wakeup(&sc->sc_uc);
			break;
		}
		sc->sc_uc.uc_lmac_error_event_table[0] = le32toh(((__uint32_t)(resp5->lmac_data[0].dbg_ptrs.error_event_table_ptr
))
		    resp5->lmac_data[0].dbg_ptrs.error_event_table_ptr)((__uint32_t)(resp5->lmac_data[0].dbg_ptrs.error_event_table_ptr
));
		sc->sc_uc.uc_lmac_error_event_table[1] = le32toh(((__uint32_t)(resp5->lmac_data[1].dbg_ptrs.error_event_table_ptr
))
		    resp5->lmac_data[1].dbg_ptrs.error_event_table_ptr)((__uint32_t)(resp5->lmac_data[1].dbg_ptrs.error_event_table_ptr
));
		sc->sc_uc.uc_log_event_table = le32toh(((__uint32_t)(resp5->lmac_data[0].dbg_ptrs.log_event_table_ptr
))
		    resp5->lmac_data[0].dbg_ptrs.log_event_table_ptr)((__uint32_t)(resp5->lmac_data[0].dbg_ptrs.log_event_table_ptr
));
		sc->sc_uc.uc_umac_error_event_table = le32toh(((__uint32_t)(resp5->umac_data.dbg_ptrs.error_info_addr))
		    resp5->umac_data.dbg_ptrs.error_info_addr)((__uint32_t)(resp5->umac_data.dbg_ptrs.error_info_addr));
		if (resp5->status == IWX_ALIVE_STATUS_OK0xCAFE)
			sc->sc_uc.uc_ok = 1;
	} else if (iwx_rx_packet_payload_len(pkt) == sizeof(*resp4)) {
		SYNC_RESP_STRUCT(resp4, pkt)do { (*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (
data->map), (sizeof(*(pkt))), (sizeof(*(resp4))), (0x02));
 resp4 = (void *)((pkt)+1); } while ( 0);
		sc->sc_uc.uc_lmac_error_event_table[0] = le32toh(((__uint32_t)(resp4->lmac_data[0].dbg_ptrs.error_event_table_ptr
))
		    resp4->lmac_data[0].dbg_ptrs.error_event_table_ptr)((__uint32_t)(resp4->lmac_data[0].dbg_ptrs.error_event_table_ptr
));
		sc->sc_uc.uc_lmac_error_event_table[1] = le32toh(((__uint32_t)(resp4->lmac_data[1].dbg_ptrs.error_event_table_ptr
))
		    resp4->lmac_data[1].dbg_ptrs.error_event_table_ptr)((__uint32_t)(resp4->lmac_data[1].dbg_ptrs.error_event_table_ptr
));
		sc->sc_uc.uc_log_event_table = le32toh(((__uint32_t)(resp4->lmac_data[0].dbg_ptrs.log_event_table_ptr
))
		    resp4->lmac_data[0].dbg_ptrs.log_event_table_ptr)((__uint32_t)(resp4->lmac_data[0].dbg_ptrs.log_event_table_ptr
));
		sc->sc_uc.uc_umac_error_event_table = le32toh(((__uint32_t)(resp4->umac_data.dbg_ptrs.error_info_addr))
		    resp4->umac_data.dbg_ptrs.error_info_addr)((__uint32_t)(resp4->umac_data.dbg_ptrs.error_info_addr));
		if (resp4->status == IWX_ALIVE_STATUS_OK0xCAFE)
			sc->sc_uc.uc_ok = 1;
	}

	sc->sc_uc.uc_intr = 1;
	wakeup(&sc->sc_uc);
	break;
}

case IWX_STATISTICS_NOTIFICATION0x9d: {
	struct iwx_notif_statistics *stats;
	SYNC_RESP_STRUCT(stats, pkt)do { (*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (
data->map), (sizeof(*(pkt))), (sizeof(*(stats))), (0x02));
 stats = (void *)((pkt)+1); } while ( 0);
	memcpy(&sc->sc_stats, stats, sizeof(sc->sc_stats))__builtin_memcpy((&sc->sc_stats), (stats), (sizeof(sc->
sc_stats)));
	sc->sc_noise = iwx_get_noise(&stats->rx.general);
	break;
}

case IWX_DTS_MEASUREMENT_NOTIFICATION0xdd:
case IWX_WIDE_ID(IWX_PHY_OPS_GROUP,((0x4 << 8) | 0xFF)
		 IWX_DTS_MEASUREMENT_NOTIF_WIDE)((0x4 << 8) | 0xFF):
case IWX_WIDE_ID(IWX_PHY_OPS_GROUP,((0x4 << 8) | 0x04)
		 IWX_TEMP_REPORTING_THRESHOLDS_CMD)((0x4 << 8) | 0x04):
	break;

case IWX_WIDE_ID(IWX_PHY_OPS_GROUP,((0x4 << 8) | 0xFE)
    IWX_CT_KILL_NOTIFICATION)((0x4 << 8) | 0xFE): {
	struct iwx_ct_kill_notif *notif;
	SYNC_RESP_STRUCT(notif, pkt)do { (*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (
data->map), (sizeof(*(pkt))), (sizeof(*(notif))), (0x02));
 notif = (void *)((pkt)+1); } while ( 0);
	printf("%s: device at critical temperature (%u degC), "
	    "stopping device\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), le16toh(notif->temperature)((__uint16_t)(notif->temperature)));
	sc->sc_flags |= IWX_FLAG_HW_ERR0x80;
	task_add(systq, &sc->init_task);
	break;
}

case IWX_WIDE_ID(IWX_MAC_CONF_GROUP,((0x3 << 8) | 0x05)
    IWX_SESSION_PROTECTION_CMD)((0x3 << 8) | 0x05):
case IWX_WIDE_ID(IWX_REGULATORY_AND_NVM_GROUP,((0xc << 8) | 0x02)
    IWX_NVM_GET_INFO)((0xc << 8) | 0x02):
case IWX_ADD_STA_KEY0x17:
case IWX_PHY_CONFIGURATION_CMD0x6a:
case IWX_TX_ANT_CONFIGURATION_CMD0x98:
case IWX_ADD_STA0x18:
case IWX_MAC_CONTEXT_CMD0x28:
case IWX_REPLY_SF_CFG_CMD0xd1:
case IWX_POWER_TABLE_CMD0x77:
case IWX_LTR_CONFIG0xee:
case IWX_PHY_CONTEXT_CMD0x8:
case IWX_BINDING_CONTEXT_CMD0x2b:
case IWX_WIDE_ID(IWX_LONG_GROUP, IWX_SCAN_CFG_CMD)((0x1 << 8) | 0xc):
case IWX_WIDE_ID(IWX_LONG_GROUP, IWX_SCAN_REQ_UMAC)((0x1 << 8) | 0xd):
case IWX_WIDE_ID(IWX_LONG_GROUP, IWX_SCAN_ABORT_UMAC)((0x1 << 8) | 0xe):
case IWX_REPLY_BEACON_FILTERING_CMD0xd2:
case IWX_MAC_PM_POWER_TABLE0xa9:
case IWX_TIME_QUOTA_CMD0x2c:
case IWX_REMOVE_STA0x19:
case IWX_TXPATH_FLUSH0x1e:
case IWX_BT_CONFIG0x9b:
case IWX_MCC_UPDATE_CMD0xc8:
case IWX_TIME_EVENT_CMD0x29:
case IWX_STATISTICS_CMD0x9c:
case IWX_SCD_QUEUE_CFG0x1d: {
	size_t pkt_len;

	if (sc->sc_cmd_resp_pkt[idx] == NULL((void *)0))
		break;

	bus_dmamap_sync(sc->sc_dmat, data->map, 0,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (sizeof(*pkt)), (0x02))
	    sizeof(*pkt), BUS_DMASYNC_POSTREAD)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (0), (sizeof(*pkt)), (0x02));

	pkt_len = sizeof(pkt->len_n_flags) +
	    iwx_rx_packet_len(pkt);

	if ((pkt->hdr.flags & IWX_CMD_FAILED_MSK0x40) ||
	    pkt_len < sizeof(*pkt) ||
	    pkt_len > sc->sc_cmd_resp_len[idx]) {
		free(sc->sc_cmd_resp_pkt[idx], M_DEVBUF2,
		    sc->sc_cmd_resp_len[idx]);
		sc->sc_cmd_resp_pkt[idx] = NULL((void *)0);
		break;
	}

	bus_dmamap_sync(sc->sc_dmat, data->map, sizeof(*pkt),(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (sizeof(*pkt)), (pkt_len - sizeof(*pkt)), (0x02))
	    pkt_len - sizeof(*pkt), BUS_DMASYNC_POSTREAD)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (data->
map), (sizeof(*pkt)), (pkt_len - sizeof(*pkt)), (0x02));
	memcpy(sc->sc_cmd_resp_pkt[idx], pkt, pkt_len)__builtin_memcpy((sc->sc_cmd_resp_pkt[idx]), (pkt), (pkt_len
));
	break;
}

case IWX_INIT_COMPLETE_NOTIF0x4:
	sc->sc_init_complete |= IWX_INIT_COMPLETE0x01;
	wakeup(&sc->sc_init_complete);
	break;

case IWX_SCAN_COMPLETE_UMAC0xf: {
	struct iwx_umac_scan_complete *notif;
	SYNC_RESP_STRUCT(notif, pkt)do { (*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (
data->map), (sizeof(*(pkt))), (sizeof(*(notif))), (0x02));
 notif = (void *)((pkt)+1); } while ( 0);
	iwx_endscan(sc);
	break;
}

case IWX_SCAN_ITERATION_COMPLETE_UMAC0xb5: {
	struct iwx_umac_scan_iter_complete_notif *notif;
	SYNC_RESP_STRUCT(notif, pkt)do { (*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (
data->map), (sizeof(*(pkt))), (sizeof(*(notif))), (0x02));
 notif = (void *)((pkt)+1); } while ( 0);
	iwx_endscan(sc);
	break;
}

case IWX_MCC_CHUB_UPDATE_CMD0xc9: {
	struct iwx_mcc_chub_notif *notif;
	SYNC_RESP_STRUCT(notif, pkt)do { (*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (
data->map), (sizeof(*(pkt))), (sizeof(*(notif))), (0x02));
 notif = (void *)((pkt)+1); } while ( 0);
	iwx_mcc_update(sc, notif);
	break;
}

case IWX_REPLY_ERROR0x2: {
	struct iwx_error_resp *resp;
	SYNC_RESP_STRUCT(resp, pkt)do { (*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (
data->map), (sizeof(*(pkt))), (sizeof(*(resp))), (0x02)); resp
 = (void *)((pkt)+1); } while ( 0);
	printf("%s: firmware error 0x%x, cmd 0x%x\n",
		DEVNAME(sc)((sc)->sc_dev.dv_xname), le32toh(resp->error_type)((__uint32_t)(resp->error_type)),
		resp->cmd_id);
	break;
}

case IWX_TIME_EVENT_NOTIFICATION0x2a: {
	struct iwx_time_event_notif *notif;
	uint32_t action;
	SYNC_RESP_STRUCT(notif, pkt)do { (*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (
data->map), (sizeof(*(pkt))), (sizeof(*(notif))), (0x02));
 notif = (void *)((pkt)+1); } while ( 0);

	if (sc->sc_time_event_uid != le32toh(notif->unique_id)((__uint32_t)(notif->unique_id)))
		break;
	action = le32toh(notif->action)((__uint32_t)(notif->action));
	if (action & IWX_TE_V2_NOTIF_HOST_EVENT_END(1 << 1))
		sc->sc_flags &= ~IWX_FLAG_TE_ACTIVE0x40;
	break;
}

case IWX_WIDE_ID(IWX_MAC_CONF_GROUP,((0x3 << 8) | 0xfb)
    IWX_SESSION_PROTECTION_NOTIF)((0x3 << 8) | 0xfb):
	break;

case IWX_WIDE_ID(IWX_SYSTEM_GROUP,((0x2 << 8) | 0xff)
    IWX_FSEQ_VER_MISMATCH_NOTIFICATION)((0x2 << 8) | 0xff):
    break;

/*
 * Firmware versions 21 and 22 generate some DEBUG_LOG_MSG
 * messages. Just ignore them for now.
 */
case IWX_DEBUG_LOG_MSG0xf7:
	break;

case IWX_MCAST_FILTER_CMD0xd0:
	break;

case IWX_WIDE_ID(IWX_DATA_PATH_GROUP, IWX_DQA_ENABLE_CMD)((0x5 << 8) | 0x00):
	break;

case IWX_WIDE_ID(IWX_SYSTEM_GROUP, IWX_SOC_CONFIGURATION_CMD)((0x2 << 8) | 0x01):
	break;

case IWX_WIDE_ID(IWX_SYSTEM_GROUP, IWX_INIT_EXTENDED_CFG_CMD)((0x2 << 8) | 0x03):
	break;

case IWX_WIDE_ID(IWX_REGULATORY_AND_NVM_GROUP,((0xc << 8) | 0x00)
    IWX_NVM_ACCESS_COMPLETE)((0xc << 8) | 0x00):
	break;

case IWX_WIDE_ID(IWX_DATA_PATH_GROUP, IWX_RX_NO_DATA_NOTIF)((0x5 << 8) | 0xf5):
	break; /* happens in monitor mode; ignore for now */

case IWX_WIDE_ID(IWX_DATA_PATH_GROUP, IWX_TLC_MNG_CONFIG_CMD)((0x5 << 8) | 0x0f):
	break;

case IWX_WIDE_ID(IWX_DATA_PATH_GROUP,((0x5 << 8) | 0xf7)
    IWX_TLC_MNG_UPDATE_NOTIF)((0x5 << 8) | 0xf7): {
	struct iwx_tlc_update_notif *notif;
	SYNC_RESP_STRUCT(notif, pkt)do { (*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (
data->map), (sizeof(*(pkt))), (sizeof(*(notif))), (0x02));
 notif = (void *)((pkt)+1); } while ( 0);
	if (iwx_rx_packet_payload_len(pkt) == sizeof(*notif))
		iwx_rs_update(sc, notif);
	break;
}

default:
	handled = 0;
	printf("%s: unhandled firmware response 0x%x/0x%x "
	    "rx ring %d[%d]\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), code, pkt->len_n_flags,
	    (qid & ~0x80), idx);
	break;
}

/*
 * uCode sets bit 0x80 when it originates the notification,
 * i.e. when the notification is not a direct response to a
 * command sent by the driver. 
 * For example, uCode issues IWX_REPLY_RX when it sends a
 * received frame to the driver.
 */
if (handled && !(qid & (1 << 7))) {
	iwx_cmd_done(sc, qid, idx, code);
}

offset += roundup(len, IWX_FH_RSCSR_FRAME_ALIGN)((((len)+((0x40)-1))/(0x40))*(0x40));
}

if (m0 && m0 != data->m)
m_freem(m0);
8931}

8933void
8934iwx_notif_intr(struct iwx_softc *sc)
8935{
struct mbuf_list ml = MBUF_LIST_INITIALIZER(){ ((void *)0), ((void *)0), 0 };
uint16_t hw;

bus_dmamap_sync(sc->sc_dmat, sc->rxq.stat_dma.map,(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (sc->
rxq.stat_dma.map), (0), (sc->rxq.stat_dma.size), (0x02))
   0, sc->rxq.stat_dma.size, BUS_DMASYNC_POSTREAD)(*(sc->sc_dmat)->_dmamap_sync)((sc->sc_dmat), (sc->
rxq.stat_dma.map), (0), (sc->rxq.stat_dma.size), (0x02));

hw = le16toh(sc->rxq.stat->closed_rb_num)((__uint16_t)(sc->rxq.stat->closed_rb_num)) & 0xfff;
hw &= (IWX_RX_MQ_RING_COUNT512 - 1);
while (sc->rxq.cur != hw) {
struct iwx_rx_data *data = &sc->rxq.data[sc->rxq.cur];
iwx_rx_pkt(sc, data, &ml);
sc->rxq.cur = (sc->rxq.cur + 1) % IWX_RX_MQ_RING_COUNT512;
}
if_input(&sc->sc_ic.ic_ific_ac.ac_if, &ml);

/*
* Tell the firmware what we have processed.
* Seems like the hardware gets upset unless we align the write by 8??
*/
hw = (hw == 0) ? IWX_RX_MQ_RING_COUNT512 - 1 : hw - 1;
IWX_WRITE(sc, IWX_RFH_Q0_FRBDCB_WIDX_TRG, hw & ~7)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((0x1C80)), (
(hw & ~7))));
8957}

8959int
8960iwx_intr(void *arg)
8961{
struct iwx_softc *sc = arg;
struct ieee80211com *ic = &sc->sc_ic;
struct ifnet *ifp = IC2IFP(ic)(&(ic)->ic_ac.ac_if);
int handled = 0;
int r1, r2, rv = 0;

IWX_WRITE(sc, IWX_CSR_INT_MASK, 0)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x00c))), (
(0))));

if (sc->sc_flags & IWX_FLAG_USE_ICT0x01) {
uint32_t *ict = sc->ict_dma.vaddr;
int tmp;

tmp = htole32(ict[sc->ict_cur])((__uint32_t)(ict[sc->ict_cur]));
if (!tmp)
	goto out_ena;

/*
 * ok, there was something.  keep plowing until we have all.
 */
r1 = r2 = 0;
while (tmp) {
	r1 |= tmp;
	ict[sc->ict_cur] = 0;
	sc->ict_cur = (sc->ict_cur+1) % IWX_ICT_COUNT(4096 / sizeof (uint32_t));
	tmp = htole32(ict[sc->ict_cur])((__uint32_t)(ict[sc->ict_cur]));
}

/* this is where the fun begins.  don't ask */
if (r1 == 0xffffffff)
	r1 = 0;

/* i am not expected to understand this */
if (r1 & 0xc0000)
	r1 |= 0x8000;
r1 = (0xff & r1) | ((0xff00 & r1) << 16);
} else {
r1 = IWX_READ(sc, IWX_CSR_INT)(((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x008)))));
if (r1 == 0xffffffff || (r1 & 0xfffffff0) == 0xa5a5a5a0)
	goto out;
r2 = IWX_READ(sc, IWX_CSR_FH_INT_STATUS)(((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x010)))));
}
if (r1 == 0 && r2 == 0) {
goto out_ena;
}

IWX_WRITE(sc, IWX_CSR_INT, r1 | ~sc->sc_intmask)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x008))), (
(r1 | ~sc->sc_intmask))));

if (r1 & IWX_CSR_INT_BIT_ALIVE(1 << 0)) {
int i;

/* Firmware has now configured the RFH. */
for (i = 0; i < IWX_RX_MQ_RING_COUNT512; i++)
	iwx_update_rx_desc(sc, &sc->rxq, i);
IWX_WRITE(sc, IWX_RFH_Q0_FRBDCB_WIDX_TRG, 8)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((0x1C80)), (
(8))));
}

handled |= (r1 & (IWX_CSR_INT_BIT_ALIVE(1 << 0) /*| IWX_CSR_INT_BIT_SCD*/));

if (r1 & IWX_CSR_INT_BIT_RF_KILL(1 << 7)) {
handled |= IWX_CSR_INT_BIT_RF_KILL(1 << 7);
iwx_check_rfkill(sc);
task_add(systq, &sc->init_task);
rv = 1;
goto out_ena;
}

if (r1 & IWX_CSR_INT_BIT_SW_ERR(1 << 25)) {
if (ifp->if_flags & IFF_DEBUG0x4) {
	iwx_nic_error(sc);
	iwx_dump_driver_status(sc);
}
printf("%s: fatal firmware error\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
if ((sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) == 0)
	task_add(systq, &sc->init_task);
rv = 1;
goto out;

}

if (r1 & IWX_CSR_INT_BIT_HW_ERR(1 << 29)) {
handled |= IWX_CSR_INT_BIT_HW_ERR(1 << 29);
printf("%s: hardware error, stopping device \n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
if ((sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) == 0) {
	sc->sc_flags |= IWX_FLAG_HW_ERR0x80;
	task_add(systq, &sc->init_task);
}
rv = 1;
goto out;
}

/* firmware chunk loaded */
if (r1 & IWX_CSR_INT_BIT_FH_TX(1 << 27)) {
IWX_WRITE(sc, IWX_CSR_FH_INT_STATUS, IWX_CSR_FH_INT_TX_MASK)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x010))), (
(((1 << 1) | (1 << 0))))));
handled |= IWX_CSR_INT_BIT_FH_TX(1 << 27);

sc->sc_fw_chunk_done = 1;
wakeup(&sc->sc_fw);
}

if (r1 & (IWX_CSR_INT_BIT_FH_RX(1U << 31) | IWX_CSR_INT_BIT_SW_RX(1 << 3) |
   IWX_CSR_INT_BIT_RX_PERIODIC(1 << 28))) {
if (r1 & (IWX_CSR_INT_BIT_FH_RX(1U << 31) | IWX_CSR_INT_BIT_SW_RX(1 << 3))) {
	handled |= (IWX_CSR_INT_BIT_FH_RX(1U << 31) | IWX_CSR_INT_BIT_SW_RX(1 << 3));
	IWX_WRITE(sc, IWX_CSR_FH_INT_STATUS, IWX_CSR_FH_INT_RX_MASK)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x010))), (
(((1 << 30) | (1 << 17) | (1 << 16))))));
}
if (r1 & IWX_CSR_INT_BIT_RX_PERIODIC(1 << 28)) {
	handled |= IWX_CSR_INT_BIT_RX_PERIODIC(1 << 28);
	IWX_WRITE(sc, IWX_CSR_INT, IWX_CSR_INT_BIT_RX_PERIODIC)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x008))), (
((1 << 28)))));
}

/* Disable periodic interrupt; we use it as just a one-shot. */
IWX_WRITE_1(sc, IWX_CSR_INT_PERIODIC_REG, IWX_CSR_INT_PERIODIC_DIS)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((0x005))), (
((0x00)))));

/*
 * Enable periodic interrupt in 8 msec only if we received
 * real RX interrupt (instead of just periodic int), to catch
 * any dangling Rx interrupt.  If it was just the periodic
 * interrupt, there was no dangling Rx activity, and no need
 * to extend the periodic interrupt; one-shot is enough.
 */
if (r1 & (IWX_CSR_INT_BIT_FH_RX(1U << 31) | IWX_CSR_INT_BIT_SW_RX(1 << 3)))
	IWX_WRITE_1(sc, IWX_CSR_INT_PERIODIC_REG,(((sc)->sc_st)->write_1(((sc)->sc_sh), (((0x005))), (
((0xFF)))))
	    IWX_CSR_INT_PERIODIC_ENA)(((sc)->sc_st)->write_1(((sc)->sc_sh), (((0x005))), (
((0xFF)))));

iwx_notif_intr(sc);
}

rv = 1;

out_ena:
iwx_restore_interrupts(sc);
out:
return rv;
9095}

9097int
9098iwx_intr_msix(void *arg)
9099{
struct iwx_softc *sc = arg;
struct ieee80211com *ic = &sc->sc_ic;
struct ifnet *ifp = IC2IFP(ic)(&(ic)->ic_ac.ac_if);
uint32_t inta_fh, inta_hw;
int vector = 0;

inta_fh = IWX_READ(sc, IWX_CSR_MSIX_FH_INT_CAUSES_AD)(((sc)->sc_st)->read_4(((sc)->sc_sh), ((((0x2000) + 0x800
)))));
inta_hw = IWX_READ(sc, IWX_CSR_MSIX_HW_INT_CAUSES_AD)(((sc)->sc_st)->read_4(((sc)->sc_sh), ((((0x2000) + 0x808
)))));
IWX_WRITE(sc, IWX_CSR_MSIX_FH_INT_CAUSES_AD, inta_fh)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x800))), ((inta_fh))));
IWX_WRITE(sc, IWX_CSR_MSIX_HW_INT_CAUSES_AD, inta_hw)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x808))), ((inta_hw))));
inta_fh &= sc->sc_fh_mask;
inta_hw &= sc->sc_hw_mask;

if (inta_fh & IWX_MSIX_FH_INT_CAUSES_Q0 ||
   inta_fh & IWX_MSIX_FH_INT_CAUSES_Q1) {
iwx_notif_intr(sc);
}

/* firmware chunk loaded */
if (inta_fh & IWX_MSIX_FH_INT_CAUSES_D2S_CH0_NUM) {
sc->sc_fw_chunk_done = 1;
wakeup(&sc->sc_fw);
}

if ((inta_fh & IWX_MSIX_FH_INT_CAUSES_FH_ERR) ||
   (inta_hw & IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR) ||
   (inta_hw & IWX_MSIX_HW_INT_CAUSES_REG_SW_ERR_V2)) {
if (ifp->if_flags & IFF_DEBUG0x4) {
	iwx_nic_error(sc);
	iwx_dump_driver_status(sc);
}
printf("%s: fatal firmware error\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
if ((sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) == 0)
	task_add(systq, &sc->init_task);
return 1;
}

if (inta_hw & IWX_MSIX_HW_INT_CAUSES_REG_RF_KILL) {
iwx_check_rfkill(sc);
task_add(systq, &sc->init_task);
}

if (inta_hw & IWX_MSIX_HW_INT_CAUSES_REG_HW_ERR) {
printf("%s: hardware error, stopping device \n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
if ((sc->sc_flags & IWX_FLAG_SHUTDOWN0x100) == 0) {
	sc->sc_flags |= IWX_FLAG_HW_ERR0x80;
	task_add(systq, &sc->init_task);
}
return 1;
}

if (inta_hw & IWX_MSIX_HW_INT_CAUSES_REG_ALIVE) {
int i;

/* Firmware has now configured the RFH. */
for (i = 0; i < IWX_RX_MQ_RING_COUNT512; i++)
	iwx_update_rx_desc(sc, &sc->rxq, i);
IWX_WRITE(sc, IWX_RFH_Q0_FRBDCB_WIDX_TRG, 8)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((0x1C80)), (
(8))));
}

/*
* Before sending the interrupt the HW disables it to prevent
* a nested interrupt. This is done by writing 1 to the corresponding
* bit in the mask register. After handling the interrupt, it should be
* re-enabled by clearing this bit. This register is defined as
* write 1 clear (W1C) register, meaning that it's being clear
* by writing 1 to the bit.
*/
IWX_WRITE(sc, IWX_CSR_MSIX_AUTOMASK_ST_AD, 1 << vector)(((sc)->sc_st)->write_4(((sc)->sc_sh), ((((0x2000) +
 0x810))), ((1 << vector))));
return 1;
9170}

9172typedef void *iwx_match_t;

9174static const struct pci_matchid iwx_devices[] = {
{ PCI_VENDOR_INTEL0x8086, PCI_PRODUCT_INTEL_WL_22500_10x2723 },
{ PCI_VENDOR_INTEL0x8086, PCI_PRODUCT_INTEL_WL_22500_20x02f0 },
{ PCI_VENDOR_INTEL0x8086, PCI_PRODUCT_INTEL_WL_22500_30xa0f0 },
{ PCI_VENDOR_INTEL0x8086, PCI_PRODUCT_INTEL_WL_22500_40x34f0,},
{ PCI_VENDOR_INTEL0x8086, PCI_PRODUCT_INTEL_WL_22500_50x06f0,},
9180};

9182static const struct pci_matchid iwx_subsystem_id_ax201[] = {
{ PCI_VENDOR_INTEL0x8086,	0x0070 },
{ PCI_VENDOR_INTEL0x8086,	0x0074 },
{ PCI_VENDOR_INTEL0x8086,	0x0078 },
{ PCI_VENDOR_INTEL0x8086,	0x007c },
{ PCI_VENDOR_INTEL0x8086,	0x0310 },
{ PCI_VENDOR_INTEL0x8086,	0x2074 },
{ PCI_VENDOR_INTEL0x8086,	0x4070 },
/* TODO: There are more ax201 devices with "main" product ID 0x06f0 */
9191};

9193int
9194iwx_match(struct device *parent, iwx_match_t match __unused__attribute__((__unused__)), void *aux)
9195{
struct pci_attach_args *pa = aux;
pcireg_t subid;
pci_vendor_id_t svid;
pci_product_id_t spid;
int i;

if (!pci_matchbyid(pa, iwx_devices, nitems(iwx_devices)(sizeof((iwx_devices)) / sizeof((iwx_devices)[0]))))
return 0;

/*
* Some PCI product IDs are shared among devices which use distinct
* chips or firmware. We need to match the subsystem ID as well to
* ensure that we have in fact found a supported device.
*/
subid = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_SUBSYS_ID_REG0x2c);
svid = PCI_VENDOR(subid)(((subid) >> 0) & 0xffff);
spid = PCI_PRODUCT(subid)(((subid) >> 16) & 0xffff);

switch (PCI_PRODUCT(pa->pa_id)(((pa->pa_id) >> 16) & 0xffff)) {
case PCI_PRODUCT_INTEL_WL_22500_10x2723: /* AX200 */
return 1; /* match any device */
case PCI_PRODUCT_INTEL_WL_22500_20x02f0: /* AX201 */
case PCI_PRODUCT_INTEL_WL_22500_30xa0f0: /* AX201 */
case PCI_PRODUCT_INTEL_WL_22500_40x34f0: /* AX201 */
case PCI_PRODUCT_INTEL_WL_22500_50x06f0: /* AX201 */
for (i = 0; i < nitems(iwx_subsystem_id_ax201)(sizeof((iwx_subsystem_id_ax201)) / sizeof((iwx_subsystem_id_ax201
)[0])); i++) {
	if (svid == iwx_subsystem_id_ax201[i].pm_vid &&
	    spid == iwx_subsystem_id_ax201[i].pm_pid)
		return 1;

}
break;
default:
break;
}

return 0;
9233}

9235int
9236iwx_preinit(struct iwx_softc *sc)
9237{
struct ieee80211com *ic = &sc->sc_ic;
struct ifnet *ifp = IC2IFP(ic)(&(ic)->ic_ac.ac_if);
int err;
static int attached;

err = iwx_prepare_card_hw(sc);
if (err) {
printf("%s: could not initialize hardware\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return err;
}

if (attached) {
/* Update MAC in case the upper layers changed it. */
IEEE80211_ADDR_COPY(sc->sc_ic.ic_myaddr,__builtin_memcpy((sc->sc_ic.ic_myaddr), (((struct arpcom *
)ifp)->ac_enaddr), (6))
    ((struct arpcom *)ifp)->ac_enaddr)__builtin_memcpy((sc->sc_ic.ic_myaddr), (((struct arpcom *
)ifp)->ac_enaddr), (6));
return 0;
}

err = iwx_start_hw(sc);
if (err) {
printf("%s: could not initialize hardware\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return err;
}

err = iwx_run_init_mvm_ucode(sc, 1);
iwx_stop_device(sc);
if (err)
return err;

/* Print version info and MAC address on first successful fw load. */
attached = 1;
printf("%s: hw rev 0x%x, fw ver %s, address %s\n",
   DEVNAME(sc)((sc)->sc_dev.dv_xname), sc->sc_hw_rev & IWX_CSR_HW_REV_TYPE_MSK(0x000FFF0),
   sc->sc_fwver, ether_sprintf(sc->sc_nvm.hw_addr));

if (sc->sc_nvm.sku_cap_11n_enable)
iwx_setup_ht_rates(sc);

/* not all hardware can do 5GHz band */
if (!sc->sc_nvm.sku_cap_band_52GHz_enable)
memset(&ic->ic_sup_rates[IEEE80211_MODE_11A], 0,__builtin_memset((&ic->ic_sup_rates[IEEE80211_MODE_11A
]), (0), (sizeof(ic->ic_sup_rates[IEEE80211_MODE_11A])))
    sizeof(ic->ic_sup_rates[IEEE80211_MODE_11A]))__builtin_memset((&ic->ic_sup_rates[IEEE80211_MODE_11A
]), (0), (sizeof(ic->ic_sup_rates[IEEE80211_MODE_11A])));

/* Configure channel information obtained from firmware. */
ieee80211_channel_init(ifp);

/* Configure MAC address. */
err = if_setlladdr(ifp, ic->ic_myaddr);
if (err)
printf("%s: could not set MAC address (error %d)\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname), err);

ieee80211_media_init(ifp, iwx_media_change, ieee80211_media_status);

return 0;
9293}

9295void
9296iwx_attach_hook(struct device *self)
9297{
struct iwx_softc *sc = (void *)self;

KASSERT(!cold)((!cold) ? (void)0 : __assert("diagnostic ", "/usr/src/sys/dev/pci/if_iwx.c"
, 9300, "!cold"));

iwx_preinit(sc);
9303}

9305void
9306iwx_attach(struct device *parent, struct device *self, void *aux)
9307{
struct iwx_softc *sc = (void *)self;
struct pci_attach_args *pa = aux;
pci_intr_handle_t ih;
pcireg_t reg, memtype;
struct ieee80211com *ic = &sc->sc_ic;
struct ifnet *ifp = &ic->ic_ific_ac.ac_if;
const char *intrstr;
int err;
int txq_i, i, j;

sc->sc_pct = pa->pa_pc;
sc->sc_pcitag = pa->pa_tag;
sc->sc_dmat = pa->pa_dmat;

rw_init(&sc->ioctl_rwl, "iwxioctl")_rw_init_flags(&sc->ioctl_rwl, "iwxioctl", 0, ((void *
)0));

err = pci_get_capability(sc->sc_pct, sc->sc_pcitag,
   PCI_CAP_PCIEXPRESS0x10, &sc->sc_cap_off, NULL((void *)0));
if (err == 0) {
printf("%s: PCIe capability structure not found!\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
return;
}

/*
* We disable the RETRY_TIMEOUT register (0x41) to keep
* PCI Tx retries from interfering with C3 CPU state.
*/
reg = pci_conf_read(sc->sc_pct, sc->sc_pcitag, 0x40);
pci_conf_write(sc->sc_pct, sc->sc_pcitag, 0x40, reg & ~0xff00);

memtype = pci_mapreg_type(pa->pa_pc, pa->pa_tag, PCI_MAPREG_START0x10);
err = pci_mapreg_map(pa, PCI_MAPREG_START0x10, memtype, 0,
   &sc->sc_st, &sc->sc_sh, NULL((void *)0), &sc->sc_sz, 0);
if (err) {
printf("%s: can't map mem space\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return;
}

if (pci_intr_map_msix(pa, 0, &ih) == 0) {
sc->sc_msix = 1;
} else if (pci_intr_map_msi(pa, &ih)) {
if (pci_intr_map(pa, &ih)) {
	printf("%s: can't map interrupt\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
	return;
}
/* Hardware bug workaround. */
reg = pci_conf_read(sc->sc_pct, sc->sc_pcitag,
    PCI_COMMAND_STATUS_REG0x04);
if (reg & PCI_COMMAND_INTERRUPT_DISABLE0x00000400)
	reg &= ~PCI_COMMAND_INTERRUPT_DISABLE0x00000400;
pci_conf_write(sc->sc_pct, sc->sc_pcitag,
    PCI_COMMAND_STATUS_REG0x04, reg);
}

intrstr = pci_intr_string(sc->sc_pct, ih);
if (sc->sc_msix)
sc->sc_ih = pci_intr_establish(sc->sc_pct, ih, IPL_NET0x7,
    iwx_intr_msix, sc, DEVNAME(sc)((sc)->sc_dev.dv_xname));
else
sc->sc_ih = pci_intr_establish(sc->sc_pct, ih, IPL_NET0x7,
    iwx_intr, sc, DEVNAME(sc)((sc)->sc_dev.dv_xname));

if (sc->sc_ih == NULL((void *)0)) {
printf("\n");
printf("%s: can't establish interrupt", DEVNAME(sc)((sc)->sc_dev.dv_xname));
if (intrstr != NULL((void *)0))
	printf(" at %s", intrstr);
printf("\n");
return;
}
printf(", %s\n", intrstr);

/* Clear pending interrupts. */
IWX_WRITE(sc, IWX_CSR_INT_MASK, 0)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x00c))), (
(0))));
IWX_WRITE(sc, IWX_CSR_INT, ~0)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x008))), (
(~0))));
IWX_WRITE(sc, IWX_CSR_FH_INT_STATUS, ~0)(((sc)->sc_st)->write_4(((sc)->sc_sh), (((0x010))), (
(~0))));

sc->sc_hw_rev = IWX_READ(sc, IWX_CSR_HW_REV)(((sc)->sc_st)->read_4(((sc)->sc_sh), (((0x028)))));

/*
* In the 8000 HW family the format of the 4 bytes of CSR_HW_REV have
* changed, and now the revision step also includes bit 0-1 (no more
* "dash" value). To keep hw_rev backwards compatible - we'll store it
* in the old format.
*/
sc->sc_hw_rev = (sc->sc_hw_rev & 0xfff0) |
	(IWX_CSR_HW_REV_STEP(sc->sc_hw_rev << 2)(((sc->sc_hw_rev << 2) & 0x000000C) >> 2) << 2);

switch (PCI_PRODUCT(pa->pa_id)(((pa->pa_id) >> 16) & 0xffff)) {
case PCI_PRODUCT_INTEL_WL_22500_10x2723:
sc->sc_fwname = "iwx-cc-a0-67";
sc->sc_device_family = IWX_DEVICE_FAMILY_220001;
sc->sc_integrated = 0;
sc->sc_ltr_delay = IWX_SOC_FLAGS_LTR_APPLY_DELAY_NONE0;
sc->sc_low_latency_xtal = 0;
sc->sc_xtal_latency = 0;
sc->sc_tx_with_siso_diversity = 0;
sc->sc_uhb_supported = 0;
break;
case PCI_PRODUCT_INTEL_WL_22500_20x02f0:
case PCI_PRODUCT_INTEL_WL_22500_30xa0f0:
case PCI_PRODUCT_INTEL_WL_22500_50x06f0:
if (sc->sc_hw_rev != IWX_CSR_HW_REV_TYPE_QUZ(0x0000354)) {
	printf("%s: unsupported AX201 adapter\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
	return;
}

sc->sc_fwname = "iwx-QuZ-a0-hr-b0-67";
sc->sc_device_family = IWX_DEVICE_FAMILY_220001;
sc->sc_integrated = 1;
sc->sc_ltr_delay = IWX_SOC_FLAGS_LTR_APPLY_DELAY_2001;
sc->sc_low_latency_xtal = 0;
sc->sc_xtal_latency = 500;
sc->sc_tx_with_siso_diversity = 0;
sc->sc_uhb_supported = 0;
break;
case PCI_PRODUCT_INTEL_WL_22500_40x34f0:
sc->sc_fwname = "iwx-Qu-c0-hr-b0-63";
sc->sc_device_family = IWX_DEVICE_FAMILY_220001;
sc->sc_integrated = 1;
sc->sc_ltr_delay = IWX_SOC_FLAGS_LTR_APPLY_DELAY_18203;
sc->sc_low_latency_xtal = 0;
sc->sc_xtal_latency = 1820;
sc->sc_tx_with_siso_diversity = 0;
sc->sc_uhb_supported = 0;
break;
default:
printf("%s: unknown adapter type\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
return;
}

/* Allocate DMA memory for loading firmware. */
err = iwx_dma_contig_alloc(sc->sc_dmat, &sc->ctxt_info_dma,
   sizeof(struct iwx_context_info), 0);
if (err) {
printf("%s: could not allocate memory for loading firmware\n",
    DEVNAME(sc)((sc)->sc_dev.dv_xname));
return;
}

/* Allocate interrupt cause table (ICT).*/
err = iwx_dma_contig_alloc(sc->sc_dmat, &sc->ict_dma,
   IWX_ICT_SIZE4096, 1<<IWX_ICT_PADDR_SHIFT12);
if (err) {
printf("%s: could not allocate ICT table\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
goto fail1;
}

for (txq_i = 0; txq_i < nitems(sc->txq)(sizeof((sc->txq)) / sizeof((sc->txq)[0])); txq_i++) {
err = iwx_alloc_tx_ring(sc, &sc->txq[txq_i], txq_i);
if (err) {
	printf("%s: could not allocate TX ring %d\n",
	    DEVNAME(sc)((sc)->sc_dev.dv_xname), txq_i);
	goto fail4;
}
}

err = iwx_alloc_rx_ring(sc, &sc->rxq);
if (err) {
printf("%s: could not allocate RX ring\n", DEVNAME(sc)((sc)->sc_dev.dv_xname));
goto fail4;
}

sc->sc_nswq = taskq_create("iwxns", 1, IPL_NET0x7, 0);
if (sc->sc_nswq == NULL((void *)0))
goto fail4;

ic->ic_phytype = IEEE80211_T_OFDM;	/* not only, but not used */
ic->ic_opmode = IEEE80211_M_STA;	/* default to BSS mode */
ic->ic_state = IEEE80211_S_INIT;

/* Set device capabilities. */
ic->ic_caps =
   IEEE80211_C_QOS0x00000800 | IEEE80211_C_TX_AMPDU0x00010000 | /* A-MPDU */
   IEEE80211_C_ADDBA_OFFLOAD0x00020000 | /* device sends ADDBA/DELBA frames */
   IEEE80211_C_WEP0x00000001 |		/* WEP */
   IEEE80211_C_RSN0x00001000 |		/* WPA/RSN */
   IEEE80211_C_SCANALL0x00000400 |	/* device scans all channels at once */
   IEEE80211_C_SCANALLBAND0x00008000 |	/* device scans all bands at once */
   IEEE80211_C_MONITOR0x00000200 |	/* monitor mode supported */
   IEEE80211_C_SHSLOT0x00000080 |	/* short slot time supported */
   IEEE80211_C_SHPREAMBLE0x00000100;	/* short preamble supported */

ic->ic_htcaps = IEEE80211_HTCAP_SGI200x00000020 | IEEE80211_HTCAP_SGI400x00000040;
ic->ic_htcaps |= IEEE80211_HTCAP_CBW20_400x00000002;
ic->ic_htcaps |=
   (IEEE80211_HTCAP_SMPS_DIS3 << IEEE80211_HTCAP_SMPS_SHIFT2);
ic->ic_htxcaps = 0;
ic->ic_txbfcaps = 0;
ic->ic_aselcaps = 0;
ic->ic_ampdu_params = (IEEE80211_AMPDU_PARAM_SS_4(5 << 2) | 0x3 /* 64k */);

ic->ic_sup_rates[IEEE80211_MODE_11A] = ieee80211_std_rateset_11a;
ic->ic_sup_rates[IEEE80211_MODE_11B] = ieee80211_std_rateset_11b;
ic->ic_sup_rates[IEEE80211_MODE_11G] = ieee80211_std_rateset_11g;

for (i = 0; i < nitems(sc->sc_phyctxt)(sizeof((sc->sc_phyctxt)) / sizeof((sc->sc_phyctxt)[0])
); i++) {
sc->sc_phyctxt[i].id = i;
sc->sc_phyctxt[i].sco = IEEE80211_HTOP0_SCO_SCN0;
}

/* IBSS channel undefined for now. */
ic->ic_ibss_chan = &ic->ic_channels[1];

ic->ic_max_rssi = IWX_MAX_DBM-33 - IWX_MIN_DBM-100;

ifp->if_softc = sc;
ifp->if_flags = IFF_BROADCAST0x2 | IFF_SIMPLEX0x800 | IFF_MULTICAST0x8000;
ifp->if_ioctl = iwx_ioctl;
ifp->if_start = iwx_start;
ifp->if_watchdog = iwx_watchdog;
memcpy(ifp->if_xname, DEVNAME(sc), IFNAMSIZ)__builtin_memcpy((ifp->if_xname), (((sc)->sc_dev.dv_xname
)), (16));

if_attach(ifp);
ieee80211_ifattach(ifp);
ieee80211_media_init(ifp, iwx_media_change, ieee80211_media_status);

9526#if NBPFILTER1 > 0
iwx_radiotap_attach(sc);
9528#endif
for (i = 0; i < nitems(sc->sc_rxba_data)(sizeof((sc->sc_rxba_data)) / sizeof((sc->sc_rxba_data)
[0])); i++) {
struct iwx_rxba_data *rxba = &sc->sc_rxba_data[i];
rxba->baid = IWX_RX_REORDER_DATA_INVALID_BAID0x7f;
rxba->sc = sc;
timeout_set(&rxba->session_timer, iwx_rx_ba_session_expired,
    rxba);
timeout_set(&rxba->reorder_buf.reorder_timer,
    iwx_reorder_timer_expired, &rxba->reorder_buf);
for (j = 0; j < nitems(rxba->entries)(sizeof((rxba->entries)) / sizeof((rxba->entries)[0])); j++)
	ml_init(&rxba->entries[j].frames);
}
task_set(&sc->init_task, iwx_init_task, sc);
task_set(&sc->newstate_task, iwx_newstate_task, sc);
task_set(&sc->ba_task, iwx_ba_task, sc);
task_set(&sc->setkey_task, iwx_setkey_task, sc);
task_set(&sc->mac_ctxt_task, iwx_mac_ctxt_task, sc);
task_set(&sc->phy_ctxt_task, iwx_phy_ctxt_task, sc);
task_set(&sc->bgscan_done_task, iwx_bgscan_done_task, sc);

ic->ic_node_alloc = iwx_node_alloc;
ic->ic_bgscan_start = iwx_bgscan;
ic->ic_bgscan_done = iwx_bgscan_done;
ic->ic_set_key = iwx_set_key;
ic->ic_delete_key = iwx_delete_key;

/* Override 802.11 state transition machine. */
sc->sc_newstate = ic->ic_newstate;
ic->ic_newstate = iwx_newstate;
ic->ic_updateprot = iwx_updateprot;
ic->ic_updateslot = iwx_updateslot;
ic->ic_updateedca = iwx_updateedca;
ic->ic_ampdu_rx_start = iwx_ampdu_rx_start;
ic->ic_ampdu_rx_stop = iwx_ampdu_rx_stop;
ic->ic_ampdu_tx_start = iwx_ampdu_tx_start;
ic->ic_ampdu_tx_stop = NULL((void *)0);
/*
* We cannot read the MAC address without loading the
* firmware from disk. Postpone until mountroot is done.
*/
config_mountroot(self, iwx_attach_hook);

return;

9572fail4:	while (--txq_i >= 0)
iwx_free_tx_ring(sc, &sc->txq[txq_i]);
iwx_free_rx_ring(sc, &sc->rxq);
if (sc->ict_dma.vaddr != NULL((void *)0))
iwx_dma_contig_free(&sc->ict_dma);

9578fail1:	iwx_dma_contig_free(&sc->ctxt_info_dma);
return;
9580}

9582#if NBPFILTER1 > 0
9583void
9584iwx_radiotap_attach(struct iwx_softc *sc)
9585{
bpfattach(&sc->sc_drvbpf, &sc->sc_ic.ic_ific_ac.ac_if, DLT_IEEE802_11_RADIO127,
   sizeof (struct ieee80211_frame) + IEEE80211_RADIOTAP_HDRLEN64);

sc->sc_rxtap_len = sizeof sc->sc_rxtapu;
sc->sc_rxtapsc_rxtapu.th.wr_ihdr.it_len = htole16(sc->sc_rxtap_len)((__uint16_t)(sc->sc_rxtap_len));
sc->sc_rxtapsc_rxtapu.th.wr_ihdr.it_present = htole32(IWX_RX_RADIOTAP_PRESENT)((__uint32_t)(((1 << IEEE80211_RADIOTAP_TSFT) | (1 <<
 IEEE80211_RADIOTAP_FLAGS) | (1 << IEEE80211_RADIOTAP_RATE
) | (1 << IEEE80211_RADIOTAP_CHANNEL) | (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL
) | (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE))));

sc->sc_txtap_len = sizeof sc->sc_txtapu;
sc->sc_txtapsc_txtapu.th.wt_ihdr.it_len = htole16(sc->sc_txtap_len)((__uint16_t)(sc->sc_txtap_len));
sc->sc_txtapsc_txtapu.th.wt_ihdr.it_present = htole32(IWX_TX_RADIOTAP_PRESENT)((__uint32_t)(((1 << IEEE80211_RADIOTAP_FLAGS) | (1 <<
 IEEE80211_RADIOTAP_RATE) | (1 << IEEE80211_RADIOTAP_CHANNEL
))));
9596}
9597#endif

9599void
9600iwx_init_task(void *arg1)
9601{
struct iwx_softc *sc = arg1;
struct ifnet *ifp = &sc->sc_ic.ic_ific_ac.ac_if;
int s = splnet()splraise(0x7);
int generation = sc->sc_generation;
int fatal = (sc->sc_flags & (IWX_FLAG_HW_ERR0x80 | IWX_FLAG_RFKILL0x02));

rw_enter_write(&sc->ioctl_rwl);
if (generation != sc->sc_generation) {
rw_exit(&sc->ioctl_rwl);
splx(s)spllower(s);
return;
}

if (ifp->if_flags & IFF_RUNNING0x40)
iwx_stop(ifp);
else
sc->sc_flags &= ~IWX_FLAG_HW_ERR0x80;

if (!fatal && (ifp->if_flags & (IFF_UP0x1 | IFF_RUNNING0x40)) == IFF_UP0x1)
iwx_init(ifp);

rw_exit(&sc->ioctl_rwl);
splx(s)spllower(s);
9625}

9627void
9628iwx_resume(struct iwx_softc *sc)
9629{
pcireg_t reg;

/*
* We disable the RETRY_TIMEOUT register (0x41) to keep
* PCI Tx retries from interfering with C3 CPU state.
*/
reg = pci_conf_read(sc->sc_pct, sc->sc_pcitag, 0x40);
pci_conf_write(sc->sc_pct, sc->sc_pcitag, 0x40, reg & ~0xff00);

if (!sc->sc_msix) {
/* Hardware bug workaround. */
reg = pci_conf_read(sc->sc_pct, sc->sc_pcitag,
    PCI_COMMAND_STATUS_REG0x04);
if (reg & PCI_COMMAND_INTERRUPT_DISABLE0x00000400)
	reg &= ~PCI_COMMAND_INTERRUPT_DISABLE0x00000400;
pci_conf_write(sc->sc_pct, sc->sc_pcitag,
    PCI_COMMAND_STATUS_REG0x04, reg);
}

iwx_disable_interrupts(sc);
9650}

9652int
9653iwx_wakeup(struct iwx_softc *sc)
9654{
struct ieee80211com *ic = &sc->sc_ic;
struct ifnet *ifp = &sc->sc_ic.ic_ific_ac.ac_if;
int err;

err = iwx_start_hw(sc);
if (err)
return err;

err = iwx_init_hw(sc);
if (err)
return err;

refcnt_init(&sc->task_refs);
ifq_clr_oactive(&ifp->if_snd);
ifp->if_flags |= IFF_RUNNING0x40;

if (ic->ic_opmode == IEEE80211_M_MONITOR)
ieee80211_new_state(ic, IEEE80211_S_RUN, -1)(((ic)->ic_newstate)((ic), (IEEE80211_S_RUN), (-1)));
else
ieee80211_begin_scan(ifp);

return 0;
9677}

9679int
9680iwx_activate(struct device *self, int act)
9681{
struct iwx_softc *sc = (struct iwx_softc *)self;
struct ifnet *ifp = &sc->sc_ic.ic_ific_ac.ac_if;
int err = 0;

switch (act) {
case DVACT_QUIESCE2:
if (ifp->if_flags & IFF_RUNNING0x40) {
	rw_enter_write(&sc->ioctl_rwl);
	iwx_stop(ifp);
	rw_exit(&sc->ioctl_rwl);
}
break;
case DVACT_RESUME4:
iwx_resume(sc);
break;
case DVACT_WAKEUP5:
if ((ifp->if_flags & (IFF_UP0x1 | IFF_RUNNING0x40)) == IFF_UP0x1) {
	err = iwx_wakeup(sc);
	if (err)
		printf("%s: could not initialize hardware\n",
		    DEVNAME(sc)((sc)->sc_dev.dv_xname));
}
break;
}

return 0;
9708}

9710struct cfdriver iwx_cd = {
NULL((void *)0), "iwx", DV_IFNET
9712};

9714struct cfattach iwx_ca = {
sizeof(struct iwx_softc), iwx_match, iwx_attach,
NULL((void *)0), iwx_activate
9717};