iwk2.c revision ff3124eff995e6cd8ebd8c6543648e0670920034
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Copyright 2008 Sun Microsystems, Inc. All rights reserved.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Use is subject to license terms.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Copyright (c) 2007, Intel Corporation
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * All rights reserved.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Copyright (c) 2006
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Copyright (c) 2007
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Damien Bergamini <damien.bergamini@free.fr>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Permission to use, copy, modify, and distribute this software for any
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * purpose with or without fee is hereby granted, provided that the above
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * copyright notice and this permission notice appear in all copies.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#pragma ident "%Z%%M% %I% %E% SMI"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Driver for Intel PRO/Wireless 4965AGN(kedron) 802.11 network adapters.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/types.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/byteorder.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/conf.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/cmn_err.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/stat.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/ddi.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/sunddi.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/strsubr.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/ethernet.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <inet/common.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <inet/nd.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <inet/mi.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/note.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/stream.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/strsun.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/modctl.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/devops.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/dlpi.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/mac.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/mac_wifi.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/net80211.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/net80211_proto.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/varargs.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/policy.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <sys/pci.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include "iwk_hw.h"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include "iwk_eeprom.h"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include "iwk2_var.h"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include <inet/wifi_ioctl.h>
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#ifdef DEBUG
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_80211 (1 << 0)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_CMD (1 << 1)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_DMA (1 << 2)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_EEPROM (1 << 3)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_FW (1 << 4)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_HW (1 << 5)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_INTR (1 << 6)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_MRR (1 << 7)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_PIO (1 << 8)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_RX (1 << 9)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_SCAN (1 << 10)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_TX (1 << 11)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_RATECTL (1 << 12)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DEBUG_RADIO (1 << 13)
43439c96b8398c01c375889c79bed72d78fb4c39hx#define IWK_DEBUG_RESUME (1 << 14)
c533a883a71cff9ff32df1c53c31201e1cbf371fhxuint32_t iwk_dbg_flags = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DBG(x) \
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_dbg x
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#else
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define IWK_DBG(x)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#endif
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void *iwk_soft_state_p = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic uint8_t iwk_fw_bin [] = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#include "fw-iw/iw4965.ucode.hex"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/* DMA attributes for a shared page */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic ddi_dma_attr_t sh_dma_attr = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DMA_ATTR_V0, /* version of this structure */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* lowest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* highest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum DMAable byte count */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x1000, /* alignment in bytes */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x1000, /* burst sizes (any?) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* minimum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum segment length */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* maximum number of segments */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* granularity */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* flags (reserved) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/* DMA attributes for a keep warm DRAM descriptor */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic ddi_dma_attr_t kw_dma_attr = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DMA_ATTR_V0, /* version of this structure */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* lowest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* highest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum DMAable byte count */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x1000, /* alignment in bytes */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x1000, /* burst sizes (any?) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* minimum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum segment length */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* maximum number of segments */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* granularity */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* flags (reserved) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/* DMA attributes for a ring descriptor */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic ddi_dma_attr_t ring_desc_dma_attr = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DMA_ATTR_V0, /* version of this structure */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* lowest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* highest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum DMAable byte count */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x100, /* alignment in bytes */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x100, /* burst sizes (any?) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* minimum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum segment length */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* maximum number of segments */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* granularity */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* flags (reserved) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/* DMA attributes for a cmd */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic ddi_dma_attr_t cmd_dma_attr = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DMA_ATTR_V0, /* version of this structure */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* lowest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* highest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum DMAable byte count */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 4, /* alignment in bytes */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x100, /* burst sizes (any?) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* minimum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum segment length */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* maximum number of segments */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* granularity */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* flags (reserved) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/* DMA attributes for a rx buffer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic ddi_dma_attr_t rx_buffer_dma_attr = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DMA_ATTR_V0, /* version of this structure */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* lowest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* highest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum DMAable byte count */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x100, /* alignment in bytes */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x100, /* burst sizes (any?) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* minimum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum segment length */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* maximum number of segments */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* granularity */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* flags (reserved) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * DMA attributes for a tx buffer.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * the maximum number of segments is 4 for the hardware.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * now all the wifi drivers put the whole frame in a single
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * descriptor, so we define the maximum number of segments 1,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * just the same as the rx_buffer. we consider leverage the HW
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * ability in the future, that is why we don't define rx and tx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * buffer_dma_attr as the same.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic ddi_dma_attr_t tx_buffer_dma_attr = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DMA_ATTR_V0, /* version of this structure */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* lowest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* highest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum DMAable byte count */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 4, /* alignment in bytes */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x100, /* burst sizes (any?) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* minimum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum segment length */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* maximum number of segments */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* granularity */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* flags (reserved) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/* DMA attributes for text and data part in the firmware */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic ddi_dma_attr_t fw_dma_attr = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DMA_ATTR_V0, /* version of this structure */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* lowest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* highest usable address */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x7fffffff, /* maximum DMAable byte count */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x10, /* alignment in bytes */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x100, /* burst sizes (any?) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* minimum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum transfer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0xffffffffU, /* maximum segment length */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* maximum number of segments */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 1, /* granularity */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, /* flags (reserved) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/* regs access attributes */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic ddi_device_acc_attr_t iwk_reg_accattr = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DEVICE_ATTR_V0,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_STRUCTURE_LE_ACC,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_STRICTORDER_ACC,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DEFAULT_ACC
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/* DMA access attributes */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic ddi_device_acc_attr_t iwk_dma_accattr = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DEVICE_ATTR_V0,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_NEVERSWAP_ACC,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_STRICTORDER_ACC,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DEFAULT_ACC
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_ring_init(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_ring_free(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_alloc_shared(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_free_shared(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_alloc_kw(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_free_kw(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_alloc_fw_dma(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_free_fw_dma(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_alloc_rx_ring(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_reset_rx_ring(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_free_rx_ring(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_alloc_tx_ring(iwk_sc_t *, iwk_tx_ring_t *,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int, int);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_reset_tx_ring(iwk_sc_t *, iwk_tx_ring_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_free_tx_ring(iwk_sc_t *, iwk_tx_ring_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
43439c96b8398c01c375889c79bed72d78fb4c39hxstatic ieee80211_node_t *iwk_node_alloc(ieee80211com_t *);
43439c96b8398c01c375889c79bed72d78fb4c39hxstatic void iwk_node_free(ieee80211_node_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_newstate(ieee80211com_t *, enum ieee80211_state, int);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_key_set(ieee80211com_t *, const struct ieee80211_key *,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx const uint8_t mac[IEEE80211_ADDR_LEN]);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_mac_access_enter(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_mac_access_exit(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic uint32_t iwk_reg_read(iwk_sc_t *, uint32_t);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_reg_write(iwk_sc_t *, uint32_t, uint32_t);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_reg_write_region_4(iwk_sc_t *, uint32_t,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t *, int);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_load_firmware(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_rx_intr(iwk_sc_t *, iwk_rx_desc_t *,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_rx_data_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_tx_intr(iwk_sc_t *, iwk_rx_desc_t *,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_rx_data_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_cmd_intr(iwk_sc_t *, iwk_rx_desc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic uint_t iwk_intr(caddr_t);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_eep_load(iwk_sc_t *sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_get_mac_from_eep(iwk_sc_t *sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_eep_sem_down(iwk_sc_t *sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_eep_sem_up(iwk_sc_t *sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic uint_t iwk_rx_softintr(caddr_t);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic uint8_t iwk_rate_to_plcp(int);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_cmd(iwk_sc_t *, int, const void *, int, int);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_set_led(iwk_sc_t *, uint8_t, uint8_t, uint8_t);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_hw_set_before_auth(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_scan(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_config(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_stop_master(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_power_up(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_preinit(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_init(iwk_sc_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_stop(iwk_sc_t *);
43439c96b8398c01c375889c79bed72d78fb4c39hxstatic void iwk_amrr_init(iwk_amrr_t *);
43439c96b8398c01c375889c79bed72d78fb4c39hxstatic void iwk_amrr_timeout(iwk_sc_t *);
43439c96b8398c01c375889c79bed72d78fb4c39hxstatic void iwk_amrr_ratectl(void *, ieee80211_node_t *);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_attach(dev_info_t *dip, ddi_attach_cmd_t cmd);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_detach(dev_info_t *dip, ddi_detach_cmd_t cmd);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * GLD specific operations
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_m_stat(void *arg, uint_t stat, uint64_t *val);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_m_start(void *arg);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_m_stop(void *arg);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_m_unicst(void *arg, const uint8_t *macaddr);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_m_multicst(void *arg, boolean_t add, const uint8_t *m);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_m_promisc(void *arg, boolean_t on);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic mblk_t *iwk_m_tx(void *arg, mblk_t *mp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_m_ioctl(void *arg, queue_t *wq, mblk_t *mp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_destroy_locks(iwk_sc_t *sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_send(ieee80211com_t *ic, mblk_t *mp, uint8_t type);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_thread(iwk_sc_t *sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Supported rates for 802.11b/g modes (in 500Kbps unit).
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * 11a and 11n support will be added later.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic const struct ieee80211_rateset iwk_rateset_11b =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx { 4, { 2, 4, 11, 22 } };
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic const struct ieee80211_rateset iwk_rateset_11g =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx { 12, { 2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108 } };
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * For mfthread only
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxextern pri_t minclsyspri;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#define DRV_NAME_4965 "iwk"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Module Loading Data & Entry Points
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxDDI_DEFINE_STREAM_OPS(iwk_devops, nulldev, nulldev, iwk_attach,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_detach, nodev, NULL, D_MP, NULL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic struct modldrv iwk_modldrv = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &mod_driverops,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "Intel(R) 4965AGN driver(N)",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &iwk_devops
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic struct modlinkage iwk_modlinkage = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx MODREV_1,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &iwk_modldrv,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx NULL
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxint
c533a883a71cff9ff32df1c53c31201e1cbf371fhx_init(void)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int status;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx status = ddi_soft_state_init(&iwk_soft_state_p,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (iwk_sc_t), 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (status != DDI_SUCCESS)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (status);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mac_init_ops(&iwk_devops, DRV_NAME_4965);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx status = mod_install(&iwk_modlinkage);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (status != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mac_fini_ops(&iwk_devops);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_soft_state_fini(&iwk_soft_state_p);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (status);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxint
c533a883a71cff9ff32df1c53c31201e1cbf371fhx_fini(void)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int status;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx status = mod_remove(&iwk_modlinkage);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (status == DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mac_fini_ops(&iwk_devops);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_soft_state_fini(&iwk_soft_state_p);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (status);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxint
c533a883a71cff9ff32df1c53c31201e1cbf371fhx_info(struct modinfo *mip)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (mod_info(&iwk_modlinkage, mip));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Mac Call Back entries
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxmac_callbacks_t iwk_m_callbacks = {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx MC_IOCTL,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_m_stat,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_m_start,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_m_stop,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_m_promisc,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_m_multicst,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_m_unicst,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_m_tx,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx NULL,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_m_ioctl
c533a883a71cff9ff32df1c53c31201e1cbf371fhx};
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#ifdef DEBUG
c533a883a71cff9ff32df1c53c31201e1cbf371fhxvoid
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_dbg(uint32_t flags, const char *fmt, ...)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx va_list ap;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (flags & iwk_dbg_flags) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx va_start(ap, fmt);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx vcmn_err(CE_NOTE, fmt, ap);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx va_end(ap);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#endif
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * device operations
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxint
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int instance, err, i;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx char strbuf[32];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx wifi_data_t wd = { 0 };
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mac_register_t *macp;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
d62cb7fff63265824a8e6725a3bcef698f6134c9hx switch (cmd) {
d62cb7fff63265824a8e6725a3bcef698f6134c9hx case DDI_ATTACH:
d62cb7fff63265824a8e6725a3bcef698f6134c9hx break;
d62cb7fff63265824a8e6725a3bcef698f6134c9hx case DDI_RESUME:
d62cb7fff63265824a8e6725a3bcef698f6134c9hx sc = ddi_get_soft_state(iwk_soft_state_p,
d62cb7fff63265824a8e6725a3bcef698f6134c9hx ddi_get_instance(dip));
d62cb7fff63265824a8e6725a3bcef698f6134c9hx ASSERT(sc != NULL);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx mutex_enter(&sc->sc_glock);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx sc->sc_flags &= ~IWK_F_SUSPEND;
d62cb7fff63265824a8e6725a3bcef698f6134c9hx mutex_exit(&sc->sc_glock);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx if (sc->sc_flags & IWK_F_RUNNING) {
d62cb7fff63265824a8e6725a3bcef698f6134c9hx (void) iwk_init(sc);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx ieee80211_new_state(&sc->sc_ic, IEEE80211_S_INIT, -1);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx }
d62cb7fff63265824a8e6725a3bcef698f6134c9hx IWK_DBG((IWK_DEBUG_RESUME, "iwk: resume\n"));
d62cb7fff63265824a8e6725a3bcef698f6134c9hx return (DDI_SUCCESS);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx default:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = DDI_FAILURE;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx instance = ddi_get_instance(dip);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = ddi_soft_state_zalloc(iwk_soft_state_p, instance);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_attach(): failed to allocate soft state\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc = ddi_get_soft_state(iwk_soft_state_p, instance);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dip = dip;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = ddi_regs_map_setup(dip, 0, &sc->sc_cfg_base, 0, 0,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &iwk_reg_accattr, &sc->sc_cfg_handle);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_attach(): failed to map config spaces regs\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail2;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_rev = ddi_get8(sc->sc_cfg_handle,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (uint8_t *)(sc->sc_cfg_base + PCI_CONF_REVID));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_put8(sc->sc_cfg_handle, (uint8_t *)(sc->sc_cfg_base + 0x41), 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_clsz = ddi_get16(sc->sc_cfg_handle,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (uint16_t *)(sc->sc_cfg_base + PCI_CONF_CACHE_LINESZ));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (!sc->sc_clsz)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_clsz = 16;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_clsz = (sc->sc_clsz << 2);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dmabuf_sz = roundup(0x1000 + sizeof (struct ieee80211_frame) +
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_MTU + IEEE80211_CRC_LEN +
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (IEEE80211_WEP_IVLEN + IEEE80211_WEP_KIDLEN +
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_WEP_CRCLEN), sc->sc_clsz);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Map operating registers
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = ddi_regs_map_setup(dip, 1, &sc->sc_base,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0, 0, &iwk_reg_accattr, &sc->sc_handle);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_attach(): failed to map device regs\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail2a;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Initialize mutexs and condvars
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = ddi_get_iblock_cookie(dip, 0, &sc->sc_iblk);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_attach(): failed to do ddi_get_iblock_cookie()\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail2b;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_init(&sc->sc_glock, NULL, MUTEX_DRIVER, sc->sc_iblk);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_init(&sc->sc_tx_lock, NULL, MUTEX_DRIVER, sc->sc_iblk);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cv_init(&sc->sc_fw_cv, NULL, CV_DRIVER, NULL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cv_init(&sc->sc_cmd_cv, NULL, CV_DRIVER, NULL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cv_init(&sc->sc_tx_cv, "tx-ring", CV_DRIVER, NULL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * initialize the mfthread
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_init(&sc->sc_mt_lock, NULL, MUTEX_DRIVER,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void *) sc->sc_iblk);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cv_init(&sc->sc_mt_cv, NULL, CV_DRIVER, NULL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_mf_thread = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_mf_thread_switch = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Allocate shared page.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_shared(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "failed to allocate shared page\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail3;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Allocate keep warm page.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_kw(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "failed to allocate keep warm page\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail3a;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Do some necessary hardware initializations.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_preinit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "failed to init hardware\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail4;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* initialize EEPROM */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_eep_load(sc); /* get hardware configurations from eeprom */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != 0) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_attach(): failed to load eeprom\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail4;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (sc->sc_eep_map.calib_version < EEP_TX_POWER_VERSION_NEW) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_EEPROM, "older EEPROM detected"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail4;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_get_mac_from_eep(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_ring_init(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_attach(): "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "failed to allocate and initialize ring\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail4;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_hdr = (iwk_firmware_hdr_t *)iwk_fw_bin;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_fw_dma(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_attach(): "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "failed to allocate firmware dma\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail5;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Initialize the wifi part, which will be used by
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * generic layer
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_phytype = IEEE80211_T_OFDM;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_state = IEEE80211_S_INIT;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_maxrssi = 100; /* experimental number */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_caps = IEEE80211_C_SHPREAMBLE | IEEE80211_C_TXPMGT |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_C_PMGT | IEEE80211_C_SHSLOT;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * use software WEP and TKIP, hardware CCMP;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_caps |= IEEE80211_C_AES_CCM;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Support WPA/WPA2
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_caps |= IEEE80211_C_WPA;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* set supported .11b and .11g rates */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_sup_rates[IEEE80211_MODE_11B] = iwk_rateset_11b;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_sup_rates[IEEE80211_MODE_11G] = iwk_rateset_11g;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* set supported .11b and .11g channels (1 through 14) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 1; i <= 14; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_sup_channels[i].ich_freq =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_sup_channels[i].ich_flags =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_ibss_chan = &ic->ic_sup_channels[0];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_xmit = iwk_send;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * init Wifi layer
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_attach(ic);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * different instance has different WPA door
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) snprintf(ic->ic_wpadoor, MAX_IEEE80211STR, "%s_%s%d", WPA_DOOR,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_driver_name(dip),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_get_instance(dip));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Override 80211 default routines
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_newstate = ic->ic_newstate;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_newstate = iwk_newstate;
43439c96b8398c01c375889c79bed72d78fb4c39hx ic->ic_node_alloc = iwk_node_alloc;
43439c96b8398c01c375889c79bed72d78fb4c39hx ic->ic_node_free = iwk_node_free;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_crypto.cs_key_set = iwk_key_set;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_media_init(ic);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * initialize default tx key
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_def_txkey = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = ddi_add_softintr(dip, DDI_SOFTINT_LOW,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &sc->sc_rx_softint_id, &sc->sc_iblk, NULL, iwk_rx_softintr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (caddr_t)sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_attach(): failed to do ddi_add_softintr()\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail7;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Add the interrupt handler
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = ddi_add_intr(dip, 0, &sc->sc_iblk, NULL,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_intr, (caddr_t)sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_attach(): failed to do ddi_add_intr()\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail8;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Initialize pointer to device specific functions
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx wd.wd_secalloc = WIFI_SEC_NONE;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx wd.wd_opmode = ic->ic_opmode;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_ADDR_COPY(wd.wd_bssid, ic->ic_macaddr);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx macp = mac_alloc(MAC_VERSION);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_attach(): failed to do mac_alloc()\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail9;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx macp->m_type_ident = MAC_PLUGIN_IDENT_WIFI;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx macp->m_driver = sc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx macp->m_dip = dip;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx macp->m_src_addr = ic->ic_macaddr;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx macp->m_callbacks = &iwk_m_callbacks;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx macp->m_min_sdu = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx macp->m_max_sdu = IEEE80211_MTU;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx macp->m_pdata = &wd;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx macp->m_pdata_size = sizeof (wd);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Register the macp to mac
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = mac_register(macp, &ic->ic_mach);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mac_free(macp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_attach(): failed to do mac_register()\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto attach_fail9;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Create minor node of type DDI_NT_NET_WIFI
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) snprintf(strbuf, sizeof (strbuf), DRV_NAME_4965"%d", instance);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = ddi_create_minor_node(dip, strbuf, S_IFCHR,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx instance + 1, DDI_NT_NET_WIFI, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_attach(): failed to do ddi_create_minor_node()\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Notify link is down now
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mac_link_update(ic->ic_mach, LINK_STATE_DOWN);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * create the mf thread to handle the link status,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * recovery fatal error, etc.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_mf_thread_switch = 1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (sc->sc_mf_thread == NULL)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_mf_thread = thread_create((caddr_t)NULL, 0,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_thread, sc, 0, &p0, TS_RUN, minclsyspri);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_flags |= IWK_F_ATTACHED;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxattach_fail9:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_remove_intr(dip, 0, sc->sc_iblk);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxattach_fail8:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_remove_softintr(sc->sc_rx_softint_id);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_rx_softint_id = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhxattach_fail7:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_detach(ic);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxattach_fail6:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_fw_dma(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxattach_fail5:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_ring_free(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxattach_fail4:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_kw(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxattach_fail3a:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_shared(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxattach_fail3:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_destroy_locks(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxattach_fail2b:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_regs_map_free(&sc->sc_handle);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxattach_fail2a:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_regs_map_free(&sc->sc_cfg_handle);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxattach_fail2:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_soft_state_free(iwk_soft_state_p, instance);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxattach_fail1:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxint
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int err;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc = ddi_get_soft_state(iwk_soft_state_p, ddi_get_instance(dip));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ASSERT(sc != NULL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
d62cb7fff63265824a8e6725a3bcef698f6134c9hx switch (cmd) {
d62cb7fff63265824a8e6725a3bcef698f6134c9hx case DDI_DETACH:
d62cb7fff63265824a8e6725a3bcef698f6134c9hx break;
d62cb7fff63265824a8e6725a3bcef698f6134c9hx case DDI_SUSPEND:
d62cb7fff63265824a8e6725a3bcef698f6134c9hx if (sc->sc_flags & IWK_F_RUNNING) {
d62cb7fff63265824a8e6725a3bcef698f6134c9hx iwk_stop(sc);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx }
d62cb7fff63265824a8e6725a3bcef698f6134c9hx mutex_enter(&sc->sc_glock);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx sc->sc_flags |= IWK_F_SUSPEND;
d62cb7fff63265824a8e6725a3bcef698f6134c9hx mutex_exit(&sc->sc_glock);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx IWK_DBG((IWK_DEBUG_RESUME, "iwk: suspend\n"));
d62cb7fff63265824a8e6725a3bcef698f6134c9hx return (DDI_SUCCESS);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx default:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_FAILURE);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx }
43439c96b8398c01c375889c79bed72d78fb4c39hx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (!(sc->sc_flags & IWK_F_ATTACHED))
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_FAILURE);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Destroy the mf_thread
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_mt_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_mf_thread_switch = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx while (sc->sc_mf_thread != NULL) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (cv_wait_sig(&sc->sc_mt_cv, &sc->sc_mt_lock) == 0)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_mt_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_stop(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(500000);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Unregiste from the MAC layer subsystem
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = mac_unregister(sc->sc_ic.ic_mach);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_fw_dma(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_ring_free(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_kw(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_shared(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_remove_intr(dip, 0, sc->sc_iblk);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_remove_softintr(sc->sc_rx_softint_id);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_rx_softint_id = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * detach ieee80211
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_detach(&sc->sc_ic);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_destroy_locks(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_regs_map_free(&sc->sc_handle);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_regs_map_free(&sc->sc_cfg_handle);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_remove_minor_node(dip, NULL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_soft_state_free(iwk_soft_state_p, ddi_get_instance(dip));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_destroy_locks(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cv_destroy(&sc->sc_mt_cv);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_destroy(&sc->sc_mt_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cv_destroy(&sc->sc_tx_cv);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cv_destroy(&sc->sc_cmd_cv);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cv_destroy(&sc->sc_fw_cv);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_destroy(&sc->sc_tx_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_destroy(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Allocate an area of memory and a DMA handle for accessing it
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_alloc_dma_mem(iwk_sc_t *sc, size_t memsize,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_dma_attr_t *dma_attr_p, ddi_device_acc_attr_t *acc_attr_p,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint_t dma_flags, iwk_dma_t *dma_p)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx caddr_t vaddr;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int err;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Allocate handle
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = ddi_dma_alloc_handle(sc->sc_dip, dma_attr_p,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_SLEEP, NULL, &dma_p->dma_hdl);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->dma_hdl = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_FAILURE);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Allocate memory
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = ddi_dma_mem_alloc(dma_p->dma_hdl, memsize, acc_attr_p,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_flags & (DDI_DMA_CONSISTENT | DDI_DMA_STREAMING),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_SLEEP, NULL, &vaddr, &dma_p->alength, &dma_p->acc_hdl);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_dma_free_handle(&dma_p->dma_hdl);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->dma_hdl = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->acc_hdl = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_FAILURE);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Bind the two together
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->mem_va = vaddr;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = ddi_dma_addr_bind_handle(dma_p->dma_hdl, NULL,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx vaddr, dma_p->alength, dma_flags, DDI_DMA_SLEEP, NULL,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &dma_p->cookie, &dma_p->ncookies);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_DMA_MAPPED) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_dma_mem_free(&dma_p->acc_hdl);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_dma_free_handle(&dma_p->dma_hdl);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->acc_hdl = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->dma_hdl = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_FAILURE);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->nslots = ~0U;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->size = ~0U;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->token = ~0U;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->offset = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Free one allocated area of DMAable memory
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_free_dma_mem(iwk_dma_t *dma_p)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (dma_p->dma_hdl != NULL) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (dma_p->ncookies) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) ddi_dma_unbind_handle(dma_p->dma_hdl);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_dma_free_handle(&dma_p->dma_hdl);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->dma_hdl = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (dma_p->acc_hdl != NULL) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_dma_mem_free(&dma_p->acc_hdl);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->acc_hdl = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_alloc_fw_dma(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int err = DDI_SUCCESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_dma_t *dma_p;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx char *t;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * firmware image layout:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * |HDR|<-TEXT->|<-DATA->|<-INIT_TEXT->|<-INIT_DATA->|<-BOOT->|
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx t = (char *)(sc->sc_hdr + 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_dma_mem(sc, LE_32(sc->sc_hdr->textsz),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &fw_dma_attr, &iwk_dma_accattr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &sc->sc_dma_fw_text);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p = &sc->sc_dma_fw_text;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "text[ncookies:%d addr:%lx size:%lx]\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies, dma_p->cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->cookie.dmac_size));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_alloc_fw_dma(): failed to alloc"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " text dma memory");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(dma_p->mem_va, t, LE_32(sc->sc_hdr->textsz));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx t += LE_32(sc->sc_hdr->textsz);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_dma_mem(sc, LE_32(sc->sc_hdr->datasz),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &fw_dma_attr, &iwk_dma_accattr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &sc->sc_dma_fw_data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p = &sc->sc_dma_fw_data;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "data[ncookies:%d addr:%lx size:%lx]\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies, dma_p->cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->cookie.dmac_size));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_alloc_fw_dma(): failed to alloc"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " data dma memory");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(dma_p->mem_va, t, LE_32(sc->sc_hdr->datasz));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_dma_mem(sc, LE_32(sc->sc_hdr->datasz),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &fw_dma_attr, &iwk_dma_accattr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &sc->sc_dma_fw_data_bak);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p = &sc->sc_dma_fw_data_bak;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "data_bak[ncookies:%d addr:%lx "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "size:%lx]\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies, dma_p->cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->cookie.dmac_size));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_alloc_fw_dma(): failed to alloc"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " data bakeup dma memory");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(dma_p->mem_va, t, LE_32(sc->sc_hdr->datasz));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx t += LE_32(sc->sc_hdr->datasz);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_dma_mem(sc, LE_32(sc->sc_hdr->init_textsz),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &fw_dma_attr, &iwk_dma_accattr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &sc->sc_dma_fw_init_text);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p = &sc->sc_dma_fw_init_text;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "init_text[ncookies:%d addr:%lx "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "size:%lx]\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies, dma_p->cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->cookie.dmac_size));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_alloc_fw_dma(): failed to alloc"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "init text dma memory");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(dma_p->mem_va, t, LE_32(sc->sc_hdr->init_textsz));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx t += LE_32(sc->sc_hdr->init_textsz);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_dma_mem(sc, LE_32(sc->sc_hdr->init_datasz),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &fw_dma_attr, &iwk_dma_accattr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &sc->sc_dma_fw_init_data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p = &sc->sc_dma_fw_init_data;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "init_data[ncookies:%d addr:%lx "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "size:%lx]\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies, dma_p->cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->cookie.dmac_size));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_alloc_fw_dma(): failed to alloc"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "init data dma memory");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(dma_p->mem_va, t, LE_32(sc->sc_hdr->init_datasz));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_boot = t + LE_32(sc->sc_hdr->init_datasz);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxfail:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_free_fw_dma(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_dma_mem(&sc->sc_dma_fw_text);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_dma_mem(&sc->sc_dma_fw_data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_dma_mem(&sc->sc_dma_fw_data_bak);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_dma_mem(&sc->sc_dma_fw_init_text);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_dma_mem(&sc->sc_dma_fw_init_data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Allocate a shared page between host and NIC.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_alloc_shared(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_dma_t *dma_p;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int err = DDI_SUCCESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* must be aligned on a 4K-page boundary */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_dma_mem(sc, sizeof (iwk_shared_t),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &sh_dma_attr, &iwk_dma_accattr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &sc->sc_dma_sh);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_shared = (iwk_shared_t *)sc->sc_dma_sh.mem_va;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p = &sc->sc_dma_sh;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "sh[ncookies:%d addr:%lx size:%lx]\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies, dma_p->cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->cookie.dmac_size));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxfail:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_shared(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_free_shared(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_dma_mem(&sc->sc_dma_sh);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Allocate a keep warm page.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_alloc_kw(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_dma_t *dma_p;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int err = DDI_SUCCESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* must be aligned on a 4K-page boundary */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_dma_mem(sc, IWK_KW_SIZE,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &kw_dma_attr, &iwk_dma_accattr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &sc->sc_dma_kw);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p = &sc->sc_dma_kw;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "kw[ncookies:%d addr:%lx size:%lx]\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies, dma_p->cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->cookie.dmac_size));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxfail:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_kw(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_free_kw(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_dma_mem(&sc->sc_dma_kw);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_alloc_rx_ring(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_rx_ring_t *ring;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_rx_data_t *data;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_dma_t *dma_p;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i, err = DDI_SUCCESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring = &sc->sc_rxq;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->cur = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_dma_mem(sc, RX_QUEUE_SIZE * sizeof (uint32_t),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &ring_desc_dma_attr, &iwk_dma_accattr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &ring->dma_desc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "dma alloc rx ring desc "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "failed\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->desc = (uint32_t *)ring->dma_desc.mem_va;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p = &ring->dma_desc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "rx bd[ncookies:%d addr:%lx size:%lx]\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies, dma_p->cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->cookie.dmac_size));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Allocate Rx buffers.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < RX_QUEUE_SIZE; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx data = &ring->data[i];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_dma_mem(sc, sc->sc_dmabuf_sz,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &rx_buffer_dma_attr, &iwk_dma_accattr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_READ | DDI_DMA_STREAMING,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &data->dma_data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "dma alloc rx ring "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "buf[%d] failed\n", i));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * the physical address bit [8-36] are used,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * instead of bit [0-31] in 3945.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->desc[i] = LE_32((uint32_t)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (data->dma_data.cookie.dmac_address >> 8));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p = &ring->data[0].dma_data;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "rx buffer[0][ncookies:%d addr:%lx "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "size:%lx]\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies, dma_p->cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->cookie.dmac_size));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DMA_SYNC(ring->dma_desc, DDI_DMA_SYNC_FORDEV);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxfail:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_rx_ring(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_reset_rx_ring(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int n;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_enter(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, FH_MEM_RCSR_CHNL0_CONFIG_REG, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (n = 0; n < 2000; n++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (IWK_READ(sc, FH_MEM_RSSR_RX_STATUS_REG) & (1 << 24))
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(1000);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#ifdef DEBUG
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (n == 2000)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "timeout resetting Rx ring\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#endif
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_exit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_rxq.cur = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_free_rx_ring(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < RX_QUEUE_SIZE; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (sc->sc_rxq.data[i].dma_data.dma_hdl)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DMA_SYNC(sc->sc_rxq.data[i].dma_data,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_SYNC_FORCPU);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_dma_mem(&sc->sc_rxq.data[i].dma_data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (sc->sc_rxq.dma_desc.dma_hdl)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DMA_SYNC(sc->sc_rxq.dma_desc, DDI_DMA_SYNC_FORDEV);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_dma_mem(&sc->sc_rxq.dma_desc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_alloc_tx_ring(iwk_sc_t *sc, iwk_tx_ring_t *ring,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int slots, int qid)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_data_t *data;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_desc_t *desc_h;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t paddr_desc_h;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_cmd_t *cmd_h;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t paddr_cmd_h;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_dma_t *dma_p;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i, err = DDI_SUCCESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->qid = qid;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->count = TFD_QUEUE_SIZE_MAX;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->window = slots;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->queued = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->cur = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_dma_mem(sc,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx TFD_QUEUE_SIZE_MAX * sizeof (iwk_tx_desc_t),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &ring_desc_dma_attr, &iwk_dma_accattr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &ring->dma_desc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "dma alloc tx ring desc[%d]"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " failed\n", qid));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p = &ring->dma_desc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "tx bd[ncookies:%d addr:%lx size:%lx]\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies, dma_p->cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->cookie.dmac_size));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc_h = (iwk_tx_desc_t *)ring->dma_desc.mem_va;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx paddr_desc_h = ring->dma_desc.cookie.dmac_address;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_dma_mem(sc,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx TFD_QUEUE_SIZE_MAX * sizeof (iwk_cmd_t),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &cmd_dma_attr, &iwk_dma_accattr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &ring->dma_cmd);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "dma alloc tx ring cmd[%d]"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " failed\n", qid));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p = &ring->dma_cmd;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "tx cmd[ncookies:%d addr:%lx size:%lx]\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies, dma_p->cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->cookie.dmac_size));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd_h = (iwk_cmd_t *)ring->dma_cmd.mem_va;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx paddr_cmd_h = ring->dma_cmd.cookie.dmac_address;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Allocate Tx buffers.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->data = kmem_zalloc(sizeof (iwk_tx_data_t) * TFD_QUEUE_SIZE_MAX,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx KM_NOSLEEP);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ring->data == NULL) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "could not allocate "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "tx data slots\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < TFD_QUEUE_SIZE_MAX; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx data = &ring->data[i];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_dma_mem(sc, sc->sc_dmabuf_sz,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &tx_buffer_dma_attr, &iwk_dma_accattr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_WRITE | DDI_DMA_STREAMING,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx &data->dma_data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "dma alloc tx "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "ring buf[%d] failed\n", i));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx data->desc = desc_h + i;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx data->paddr_desc = paddr_desc_h +
ff3124eff995e6cd8ebd8c6543648e0670920034ff _PTRDIFF(data->desc, desc_h);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx data->cmd = cmd_h + i; /* (i % slots); */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx data->paddr_cmd = paddr_cmd_h +
ff3124eff995e6cd8ebd8c6543648e0670920034ff _PTRDIFF(data->cmd, cmd_h);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* ((i % slots) * sizeof (iwk_cmd_t)); */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p = &ring->data[0].dma_data;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "tx buffer[0][ncookies:%d addr:%lx "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "size:%lx]\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->ncookies, dma_p->cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx dma_p->cookie.dmac_size));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxfail:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ring->data)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx kmem_free(ring->data,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (iwk_tx_data_t) * TFD_QUEUE_SIZE_MAX);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_tx_ring(sc, ring);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_reset_tx_ring(iwk_sc_t *sc, iwk_tx_ring_t *ring)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_data_t *data;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i, n;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_enter(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, IWK_FH_TCSR_CHNL_TX_CONFIG_REG(ring->qid), 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (n = 0; n < 200; n++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (IWK_READ(sc, IWK_FH_TSSR_TX_STATUS_REG) &
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_FH_TSSR_TX_STATUS_REG_MSK_CHNL_IDLE(ring->qid))
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(10);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#ifdef DEBUG
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (n == 200 && iwk_dbg_flags > 0) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_DMA, "timeout reset tx ring %d\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->qid));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#endif
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_exit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < ring->count; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx data = &ring->data[i];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DMA_SYNC(data->dma_data, DDI_DMA_SYNC_FORDEV);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->queued = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->cur = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*ARGSUSED*/
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_free_tx_ring(iwk_sc_t *sc, iwk_tx_ring_t *ring)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ring->dma_desc.dma_hdl != NULL)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DMA_SYNC(ring->dma_desc, DDI_DMA_SYNC_FORDEV);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_dma_mem(&ring->dma_desc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ring->dma_cmd.dma_hdl != NULL)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DMA_SYNC(ring->dma_cmd, DDI_DMA_SYNC_FORDEV);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_dma_mem(&ring->dma_cmd);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ring->data != NULL) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < ring->count; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ring->data[i].dma_data.dma_hdl)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DMA_SYNC(ring->data[i].dma_data,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DDI_DMA_SYNC_FORDEV);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_dma_mem(&ring->data[i].dma_data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx kmem_free(ring->data, ring->count * sizeof (iwk_tx_data_t));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_ring_init(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i, err = DDI_SUCCESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < IWK_NUM_QUEUES; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (i == IWK_CMD_QUEUE_NUM)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx continue;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_tx_ring(sc, &sc->sc_txq[i], TFD_TX_CMD_SLOTS,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx i);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_tx_ring(sc, &sc->sc_txq[IWK_CMD_QUEUE_NUM],
c533a883a71cff9ff32df1c53c31201e1cbf371fhx TFD_CMD_SLOTS, IWK_CMD_QUEUE_NUM);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_alloc_rx_ring(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != DDI_SUCCESS)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxfail:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_ring_free(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i = IWK_NUM_QUEUES;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_rx_ring(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx while (--i >= 0) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_free_tx_ring(sc, &sc->sc_txq[i]);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
43439c96b8398c01c375889c79bed72d78fb4c39hx/* ARGSUSED */
43439c96b8398c01c375889c79bed72d78fb4c39hxstatic ieee80211_node_t *
43439c96b8398c01c375889c79bed72d78fb4c39hxiwk_node_alloc(ieee80211com_t *ic)
43439c96b8398c01c375889c79bed72d78fb4c39hx{
43439c96b8398c01c375889c79bed72d78fb4c39hx iwk_amrr_t *amrr;
43439c96b8398c01c375889c79bed72d78fb4c39hx
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr = kmem_zalloc(sizeof (iwk_amrr_t), KM_SLEEP);
43439c96b8398c01c375889c79bed72d78fb4c39hx if (amrr != NULL)
43439c96b8398c01c375889c79bed72d78fb4c39hx iwk_amrr_init(amrr);
43439c96b8398c01c375889c79bed72d78fb4c39hx return (&amrr->in);
43439c96b8398c01c375889c79bed72d78fb4c39hx}
43439c96b8398c01c375889c79bed72d78fb4c39hx
43439c96b8398c01c375889c79bed72d78fb4c39hxstatic void
43439c96b8398c01c375889c79bed72d78fb4c39hxiwk_node_free(ieee80211_node_t *in)
43439c96b8398c01c375889c79bed72d78fb4c39hx{
43439c96b8398c01c375889c79bed72d78fb4c39hx ieee80211com_t *ic = in->in_ic;
43439c96b8398c01c375889c79bed72d78fb4c39hx
43439c96b8398c01c375889c79bed72d78fb4c39hx ic->ic_node_cleanup(in);
43439c96b8398c01c375889c79bed72d78fb4c39hx if (in->in_wpa_ie != NULL)
43439c96b8398c01c375889c79bed72d78fb4c39hx ieee80211_free(in->in_wpa_ie);
43439c96b8398c01c375889c79bed72d78fb4c39hx kmem_free(in, sizeof (iwk_amrr_t));
43439c96b8398c01c375889c79bed72d78fb4c39hx}
43439c96b8398c01c375889c79bed72d78fb4c39hx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*ARGSUSED*/
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_newstate(ieee80211com_t *ic, enum ieee80211_state nstate, int arg)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc = (iwk_sc_t *)ic;
43439c96b8398c01c375889c79bed72d78fb4c39hx ieee80211_node_t *in = ic->ic_bss;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_power_table_cmd_t txpower;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx enum ieee80211_state ostate = ic->ic_state;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i, err = IWK_SUCCESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx switch (nstate) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_S_SCAN:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ostate == IEEE80211_S_INIT) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_flags |= IEEE80211_F_SCAN | IEEE80211_F_ASCAN;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* let LED blink when scanning */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_set_led(sc, 2, 10, 2);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((err = iwk_scan(sc)) != 0) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_80211,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "could not initiate scan\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_flags &= ~(IEEE80211_F_SCAN |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_F_ASCAN);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_state = nstate;
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_clk = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_S_AUTH:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* reset state to handle reassociations correctly */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.assoc_id = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.filter_flags &= ~LE_32(RXON_FILTER_ASSOC_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * before sending authentication and association request frame,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * we need do something in the hardware, such as setting the
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * channel same to the target AP...
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((err = iwk_hw_set_before_auth(sc)) != 0) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_80211,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "could not send authentication request\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_S_RUN:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_opmode == IEEE80211_M_MONITOR) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* let LED blink when monitoring */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_set_led(sc, 2, 10, 10);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_opmode != IEEE80211_M_STA) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) iwk_hw_set_before_auth(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* need setup beacon here */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_80211, "iwk: associated."));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* update adapter's configuration */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.assoc_id = sc->sc_assoc_id & 0x3fff;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* short preamble/slot time are negotiated when associating */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.flags &= ~LE_32(RXON_FLG_SHORT_PREAMBLE_MSK |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx RXON_FLG_SHORT_SLOT_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_flags & IEEE80211_F_SHSLOT)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.flags |= LE_32(RXON_FLG_SHORT_SLOT_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_flags & IEEE80211_F_SHPREAMBLE)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.flags |=
c533a883a71cff9ff32df1c53c31201e1cbf371fhx LE_32(RXON_FLG_SHORT_PREAMBLE_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.filter_flags |= LE_32(RXON_FILTER_ASSOC_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_opmode != IEEE80211_M_STA)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.filter_flags |=
c533a883a71cff9ff32df1c53c31201e1cbf371fhx LE_32(RXON_FILTER_BCON_AWARE_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_80211, "config chan %d flags %x"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " filter_flags %x\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.chan, sc->sc_config.flags,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.filter_flags));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, REPLY_RXON, &sc->sc_config,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (iwk_rxon_cmd_t), 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_80211,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "could not update configuration\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * set Tx power for 2.4GHz channels
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * (need further investigation. fix tx power at present)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * This cmd should be issued each time the reply_rxon cmd is
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * invoked.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(&txpower, 0, sizeof (txpower));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.band = 1; /* for 2.4G */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.channel = sc->sc_config.chan;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.channel_normal_width = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < POWER_TABLE_NUM_HT_OFDM_ENTRIES; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.tx_power.ht_ofdm_power[i].s.ramon_tx_gain =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 0x3f3f;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.tx_power.ht_ofdm_power[i].s.dsp_predis_atten =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx 110 | (110 << 8);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.tx_power.ht_ofdm_power[POWER_TABLE_NUM_HT_OFDM_ENTRIES]
c533a883a71cff9ff32df1c53c31201e1cbf371fhx .s.ramon_tx_gain = 0x3f3f;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.tx_power.ht_ofdm_power[POWER_TABLE_NUM_HT_OFDM_ENTRIES]
c533a883a71cff9ff32df1c53c31201e1cbf371fhx .s.dsp_predis_atten = 110 | (110 << 8);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, REPLY_TX_PWR_TABLE_CMD, &txpower,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (txpower), 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_newstate(): failed to "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "set txpower\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
43439c96b8398c01c375889c79bed72d78fb4c39hx /* start automatic rate control */
43439c96b8398c01c375889c79bed72d78fb4c39hx mutex_enter(&sc->sc_mt_lock);
43439c96b8398c01c375889c79bed72d78fb4c39hx if (ic->ic_fixed_rate == IEEE80211_FIXED_RATE_NONE) {
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_flags |= IWK_F_RATE_AUTO_CTL;
43439c96b8398c01c375889c79bed72d78fb4c39hx /* set rate to some reasonable initial value */
43439c96b8398c01c375889c79bed72d78fb4c39hx i = in->in_rates.ir_nrates - 1;
43439c96b8398c01c375889c79bed72d78fb4c39hx while (i > 0 && IEEE80211_RATE(i) > 72)
43439c96b8398c01c375889c79bed72d78fb4c39hx i--;
43439c96b8398c01c375889c79bed72d78fb4c39hx in->in_txrate = i;
43439c96b8398c01c375889c79bed72d78fb4c39hx } else {
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_flags &= ~IWK_F_RATE_AUTO_CTL;
43439c96b8398c01c375889c79bed72d78fb4c39hx }
43439c96b8398c01c375889c79bed72d78fb4c39hx mutex_exit(&sc->sc_mt_lock);
43439c96b8398c01c375889c79bed72d78fb4c39hx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* set LED on after associated */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_set_led(sc, 2, 0, 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_S_INIT:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* set LED off after init */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_set_led(sc, 2, 1, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_S_ASSOC:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (sc->sc_newstate(ic, nstate, arg));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*ARGSUSED*/
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_key_set(ieee80211com_t *ic, const struct ieee80211_key *k,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx const uint8_t mac[IEEE80211_ADDR_LEN])
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc = (iwk_sc_t *)ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_add_sta_t node;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int err;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx switch (k->wk_cipher->ic_cipher) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_CIPHER_WEP:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_CIPHER_TKIP:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (1); /* sofeware do it. */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_CIPHER_AES_CCM:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx default:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.filter_flags &= ~(RXON_FILTER_DIS_DECRYPT_MSK
c533a883a71cff9ff32df1c53c31201e1cbf371fhx | RXON_FILTER_DIS_GRP_DECRYPT_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* update ap/multicast node */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(&node, 0, sizeof (node));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (IEEE80211_IS_MULTICAST(mac)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(node.bssid, 0xff, 6);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx node.id = IWK_BROADCAST_ID;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx } else {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_ADDR_COPY(node.bssid, ic->ic_bss->in_bssid);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx node.id = IWK_AP_ID;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (k->wk_flags & IEEE80211_KEY_XMIT) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx node.key_flags = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx node.keyp = k->wk_keyix;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx } else {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx node.key_flags = (1 << 14);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx node.keyp = k->wk_keyix + 4;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(node.key, k->wk_key, k->wk_keylen);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx node.key_flags |= (STA_KEY_FLG_CCMP | (1 << 3) | (k->wk_keyix << 8));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx node.sta_mask = STA_MODIFY_KEY_MASK;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx node.control = 1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, REPLY_ADD_STA, &node, sizeof (node), 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_key_set():"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "failed to update ap node\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * exclusive access to mac begin.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_mac_access_enter(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t tmp;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int n;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = IWK_READ(sc, CSR_GP_CNTRL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_GP_CNTRL,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp | CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* wait until we succeed */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (n = 0; n < 1000; n++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((IWK_READ(sc, CSR_GP_CNTRL) &
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx CSR_GP_CNTRL_REG_FLAG_GOING_TO_SLEEP)) ==
c533a883a71cff9ff32df1c53c31201e1cbf371fhx CSR_GP_CNTRL_REG_VAL_MAC_ACCESS_EN)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(10);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (n == 1000)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_PIO, "could not lock memory\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * exclusive access to mac end.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_mac_access_exit(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t tmp = IWK_READ(sc, CSR_GP_CNTRL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_GP_CNTRL,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp & ~CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * this function defined here for future use.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * static uint32_t
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * iwk_mem_read(iwk_sc_t *sc, uint32_t addr)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * IWK_WRITE(sc, HBUS_TARG_MEM_RADDR, addr);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * return (IWK_READ(sc, HBUS_TARG_MEM_RDAT));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_mem_write(iwk_sc_t *sc, uint32_t addr, uint32_t data)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, HBUS_TARG_MEM_WADDR, addr);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, HBUS_TARG_MEM_WDAT, data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic uint32_t
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_reg_read(iwk_sc_t *sc, uint32_t addr)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, HBUS_TARG_PRPH_RADDR, addr | (3 << 24));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_READ(sc, HBUS_TARG_PRPH_RDAT));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_reg_write(iwk_sc_t *sc, uint32_t addr, uint32_t data)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, HBUS_TARG_PRPH_WADDR, addr | (3 << 24));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, HBUS_TARG_PRPH_WDAT, data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_reg_write_region_4(iwk_sc_t *sc, uint32_t addr,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t *data, int wlen)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (; wlen > 0; wlen--, data++, addr += 4)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, addr, *data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * ucode load/initialization steps:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * 1) load Bootstrap State Machine (BSM) with "bootstrap" uCode image.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * BSM contains a small memory that *always* stays powered up, so it can
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * retain the bootstrap program even when the card is in a power-saving
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * power-down state. The BSM loads the small program into ARC processor's
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * instruction memory when triggered by power-up.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * 2) load Initialize image via bootstrap program.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * The Initialize image sets up regulatory and calibration data for the
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Runtime/Protocol uCode. This sends a REPLY_ALIVE notification when completed.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * The 4965 reply contains calibration data for temperature, voltage and tx gain
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * correction.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_load_firmware(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t *boot_fw = (uint32_t *)sc->sc_boot;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t size = sc->sc_hdr->bootsz;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int n, err = IWK_SUCCESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * The physical address bit [4-35] of the initialize uCode.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * In the initialize alive notify interrupt the physical address of
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * the runtime ucode will be set for loading.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_enter(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_DRAM_INST_PTR_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dma_fw_init_text.cookie.dmac_address >> 4);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_DRAM_DATA_PTR_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dma_fw_init_data.cookie.dmac_address >> 4);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_DRAM_INST_BYTECOUNT_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dma_fw_init_text.cookie.dmac_size);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_DRAM_DATA_BYTECOUNT_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dma_fw_init_data.cookie.dmac_size);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* load bootstrap code into BSM memory */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write_region_4(sc, BSM_SRAM_LOWER_BOUND, boot_fw,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx size / sizeof (uint32_t));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_WR_MEM_SRC_REG, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_WR_MEM_DST_REG, RTC_INST_LOWER_BOUND);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_WR_DWCOUNT_REG, size / sizeof (uint32_t));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * prepare to load initialize uCode
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_WR_CTRL_REG, BSM_WR_CTRL_REG_BIT_START);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* wait while the adapter is busy loading the firmware */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (n = 0; n < 1000; n++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (!(iwk_reg_read(sc, BSM_WR_CTRL_REG) &
c533a883a71cff9ff32df1c53c31201e1cbf371fhx BSM_WR_CTRL_REG_BIT_START))
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(10);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (n == 1000) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_FW,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "timeout transferring firmware\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = ETIMEDOUT;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* for future power-save mode use */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_WR_CTRL_REG, BSM_WR_CTRL_REG_BIT_START_EN);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_exit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*ARGSUSED*/
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_rx_intr(iwk_sc_t *sc, iwk_rx_desc_t *desc, iwk_rx_data_t *data)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_rx_ring_t *ring = &sc->sc_rxq;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_rx_phy_res_t *stat;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_node_t *in;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t *tail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx struct ieee80211_frame *wh;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mblk_t *mp;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint16_t len, rssi, mrssi, agc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int16_t t;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t ants, i;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx struct iwk_rx_non_cfg_phy *phyinfo;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* assuming not 11n here. cope with 11n in phase-II */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx stat = (iwk_rx_phy_res_t *)(desc + 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (stat->cfg_phy_cnt > 20) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx phyinfo = (struct iwk_rx_non_cfg_phy *)stat->non_cfg_phy;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx agc = (phyinfo->agc_info & IWK_AGC_DB_MASK) >> IWK_AGC_DB_POS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mrssi = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ants = (stat->phy_flags & RX_PHY_FLAGS_ANTENNAE_MASK)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx >> RX_PHY_FLAGS_ANTENNAE_OFFSET;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < 3; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ants & (1 << i))
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mrssi = MAX(mrssi, phyinfo->rssi_info[i << 1]);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx t = mrssi - agc - 44; /* t is the dBM value */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * convert dBm to percentage ???
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rssi = (100 * 75 * 75 - (-20 - t) * (15 * 75 + 62 * (-20 - t)))
c533a883a71cff9ff32df1c53c31201e1cbf371fhx / (75 * 75);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (rssi > 100)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rssi = 100;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (rssi < 1)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rssi = 1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx len = stat->byte_count;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tail = (uint32_t *)((uint8_t *)(stat + 1) + stat->cfg_phy_cnt + len);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_RX, "rx intr: idx=%d phy_len=%x len=%d "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "rate=%x chan=%d tstamp=%x non_cfg_phy_count=%x "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "cfg_phy_count=%x tail=%x", ring->cur, sizeof (*stat),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx len, stat->rate.r.s.rate, stat->channel,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx LE_32(stat->timestampl), stat->non_cfg_phy_cnt,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx stat->cfg_phy_cnt, LE_32(*tail)));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((len < 16) || (len > sc->sc_dmabuf_sz)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_RX, "rx frame oversize\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * discard Rx frames with bad CRC
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((LE_32(*tail) &
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (RX_RES_STATUS_NO_CRC32_ERROR | RX_RES_STATUS_NO_RXE_OVERFLOW)) !=
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (RX_RES_STATUS_NO_CRC32_ERROR | RX_RES_STATUS_NO_RXE_OVERFLOW)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_RX, "rx crc error tail: %x\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx LE_32(*tail)));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_rx_err++;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx wh = (struct ieee80211_frame *)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ((uint8_t *)(stat + 1)+ stat->cfg_phy_cnt);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (*(uint8_t *)wh == IEEE80211_FC0_SUBTYPE_ASSOC_RESP) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_assoc_id = *((uint16_t *)(wh + 1) + 2);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_RX, "rx : association id = %x\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_assoc_id));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#ifdef DEBUG
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (iwk_dbg_flags & IWK_DEBUG_RX)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_dump_pkt((uint8_t *)wh, len, 0, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#endif
c533a883a71cff9ff32df1c53c31201e1cbf371fhx in = ieee80211_find_rxnode(ic, wh);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mp = allocb(len, BPRI_MED);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (mp) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(mp->b_wptr, wh, len);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mp->b_wptr += len;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* send the frame to the 802.11 layer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) ieee80211_input(ic, mp, in, rssi, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx } else {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_rx_nobuf++;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_RX,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_rx_intr(): alloc rx buf failed\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* release node reference */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_free_node(in);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*ARGSUSED*/
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_tx_intr(iwk_sc_t *sc, iwk_rx_desc_t *desc, iwk_rx_data_t *data)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_ring_t *ring = &sc->sc_txq[desc->hdr.qid & 0x3];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_stat_t *stat = (iwk_tx_stat_t *)(desc + 1);
43439c96b8398c01c375889c79bed72d78fb4c39hx iwk_amrr_t *amrr = (iwk_amrr_t *)ic->ic_bss;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_TX, "tx done: qid=%d idx=%d"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " retries=%d frame_count=%x nkill=%d "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "rate=%x duration=%d status=%x\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->hdr.qid, desc->hdr.idx, stat->ntries, stat->frame_count,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx stat->bt_kill_count, stat->rate.r.s.rate,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx LE_32(stat->duration), LE_32(stat->status)));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->txcnt++;
43439c96b8398c01c375889c79bed72d78fb4c39hx IWK_DBG((IWK_DEBUG_RATECTL, "tx: %d cnt\n", amrr->txcnt));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (stat->ntries > 0) {
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->retrycnt++;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_tx_retries++;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_TX, "tx: %d retries\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_tx_retries));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_tx_timer = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_tx_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->queued--;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ring->queued < 0)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->queued = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((sc->sc_need_reschedule) && (ring->queued <= (ring->count << 3))) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_need_reschedule = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_tx_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mac_tx_update(ic->ic_mach);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_tx_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_tx_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_cmd_intr(iwk_sc_t *sc, iwk_rx_desc_t *desc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((desc->hdr.qid & 7) != 4) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_flags |= IWK_F_CMD_DONE;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cv_signal(&sc->sc_cmd_cv);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_CMD, "rx cmd: "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "qid=%x idx=%d flags=%x type=0x%x\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->hdr.qid, desc->hdr.idx, desc->hdr.flags,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->hdr.type));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_ucode_alive(iwk_sc_t *sc, iwk_rx_desc_t *desc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t base, i;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx struct iwk_alive_resp *ar =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (struct iwk_alive_resp *)(desc + 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* the microcontroller is ready */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_FW,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "microcode alive notification minor: %x major: %x type:"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " %x subtype: %x\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ar->ucode_minor, ar->ucode_minor, ar->ver_type, ar->ver_subtype));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (LE_32(ar->is_valid) != UCODE_VALID_OK) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_FW,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "microcontroller initialization failed\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ar->ver_subtype == INITIALIZE_SUBTYPE) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_FW,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "initialization alive received.\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(&sc->sc_card_alive_init, ar,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (struct iwk_init_alive_resp));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* XXX get temperature */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_enter(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_DRAM_INST_PTR_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dma_fw_text.cookie.dmac_address >> 4);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_DRAM_DATA_PTR_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dma_fw_data_bak.cookie.dmac_address >> 4);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_DRAM_DATA_BYTECOUNT_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dma_fw_data.cookie.dmac_size);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, BSM_DRAM_INST_BYTECOUNT_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dma_fw_text.cookie.dmac_size | 0x80000000);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_exit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx } else {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_FW, "runtime alive received.\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(&sc->sc_card_alive_run, ar,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (struct iwk_alive_resp));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Init SCD related registers to make Tx work. XXX
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_enter(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* read sram address of data base */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_scd_base = iwk_reg_read(sc, SCD_SRAM_BASE_ADDR);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* clear and init SCD_CONTEXT_DATA_OFFSET area. 128 bytes */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (base = sc->sc_scd_base + SCD_CONTEXT_DATA_OFFSET, i = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx i < 128; i += 4)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mem_write(sc, base + i, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* clear and init SCD_TX_STTS_BITMAP_OFFSET area. 256 bytes */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (base = sc->sc_scd_base + SCD_TX_STTS_BITMAP_OFFSET;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx i < 256; i += 4)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mem_write(sc, base + i, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* clear and init SCD_TRANSLATE_TBL_OFFSET area. 32 bytes */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (base = sc->sc_scd_base + SCD_TRANSLATE_TBL_OFFSET;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx i < sizeof (uint16_t) * IWK_NUM_QUEUES; i += 4)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mem_write(sc, base + i, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, SCD_DRAM_BASE_ADDR,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dma_sh.cookie.dmac_address >> 10);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, SCD_QUEUECHAIN_SEL, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* initiate the tx queues */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < IWK_NUM_QUEUES; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, SCD_QUEUE_RDPTR(i), 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, HBUS_TARG_WRPTR, (i << 8));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mem_write(sc, sc->sc_scd_base +
c533a883a71cff9ff32df1c53c31201e1cbf371fhx SCD_CONTEXT_QUEUE_OFFSET(i),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (SCD_WIN_SIZE & 0x7f));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mem_write(sc, sc->sc_scd_base +
c533a883a71cff9ff32df1c53c31201e1cbf371fhx SCD_CONTEXT_QUEUE_OFFSET(i) + sizeof (uint32_t),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (SCD_FRAME_LIMIT & 0x7f) << 16);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* interrupt enable on each queue0-7 */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, SCD_INTERRUPT_MASK,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (1 << IWK_NUM_QUEUES) - 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* enable each channel 0-7 */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, SCD_TXFACT,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx SCD_TXFACT_REG_TXFIFO_MASK(0, 7));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * queue 0-7 maps to FIFO 0-7 and
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * all queues work under FIFO mode (none-scheduler-ack)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < 7; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx SCD_QUEUE_STATUS_BITS(i),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (1 << SCD_QUEUE_STTS_REG_POS_ACTIVE)|
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (i << SCD_QUEUE_STTS_REG_POS_TXF)|
c533a883a71cff9ff32df1c53c31201e1cbf371fhx SCD_QUEUE_STTS_REG_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_exit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_flags |= IWK_F_FW_INIT;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cv_signal(&sc->sc_fw_cv);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic uint_t
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_rx_softintr(caddr_t arg)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc = (iwk_sc_t *)arg;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_rx_desc_t *desc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_rx_data_t *data;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t index;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (sc->sc_rx_softint_pending != 1) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_INTR_UNCLAIMED);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* disable interrupts */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_INT_MASK, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * firmware has moved the index of the rx queue, driver get it,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * and deal with it.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx index = LE_32(sc->sc_shared->val0) & 0xfff;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx while (sc->sc_rxq.cur != index) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx data = &sc->sc_rxq.data[sc->sc_rxq.cur];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc = (iwk_rx_desc_t *)data->dma_data.mem_va;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_INTR, "rx notification index = %d"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " cur = %d qid=%x idx=%d flags=%x type=%x len=%d\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx index, sc->sc_rxq.cur, desc->hdr.qid, desc->hdr.idx,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->hdr.flags, desc->hdr.type, LE_32(desc->len)));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* a command other than a tx need to be replied */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (!(desc->hdr.qid & 0x80) &&
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (desc->hdr.type != REPLY_RX_PHY_CMD) &&
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (desc->hdr.type != REPLY_TX))
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_cmd_intr(sc, desc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx switch (desc->hdr.type) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case REPLY_4965_RX:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_rx_intr(sc, desc, data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case REPLY_TX:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_intr(sc, desc, data);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case REPLY_ALIVE:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_ucode_alive(sc, desc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case CARD_STATE_NOTIFICATION:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t *status = (uint32_t *)(desc + 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_RADIO, "state changed to %x\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx LE_32(*status)));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (LE_32(*status) & 1) {
43439c96b8398c01c375889c79bed72d78fb4c39hx /*
43439c96b8398c01c375889c79bed72d78fb4c39hx * the radio button has to be pushed(OFF). It
43439c96b8398c01c375889c79bed72d78fb4c39hx * is considered as a hw error, the
43439c96b8398c01c375889c79bed72d78fb4c39hx * iwk_thread() tries to recover it after the
43439c96b8398c01c375889c79bed72d78fb4c39hx * button is pushed again(ON)
43439c96b8398c01c375889c79bed72d78fb4c39hx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_NOTE,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk: Radio transmitter is off\n");
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_ostate = sc->sc_ic.ic_state;
43439c96b8398c01c375889c79bed72d78fb4c39hx ieee80211_new_state(&sc->sc_ic,
43439c96b8398c01c375889c79bed72d78fb4c39hx IEEE80211_S_INIT, -1);
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_flags |=
43439c96b8398c01c375889c79bed72d78fb4c39hx (IWK_F_HW_ERR_RECOVER | IWK_F_RADIO_OFF);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case SCAN_START_NOTIFICATION:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_start_scan_t *scan =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (iwk_start_scan_t *)(desc + 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_SCAN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "scanning channel %d status %x\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx scan->chan, LE_32(scan->status)));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_curchan = &ic->ic_sup_channels[scan->chan];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case SCAN_COMPLETE_NOTIFICATION:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_SCAN, "scan finished\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_end_scan(ic);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_rxq.cur = (sc->sc_rxq.cur + 1) % RX_QUEUE_SIZE;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * driver dealt with what reveived in rx queue and tell the information
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * to the firmware.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx index = (index == 0) ? RX_QUEUE_SIZE - 1 : index - 1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, FH_RSCSR_CHNL0_RBDCB_WPTR_REG, index & (~7));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* re-enable interrupts */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_INT_MASK, CSR_INI_SET_MASK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_rx_softint_pending = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_INTR_CLAIMED);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic uint_t
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_intr(caddr_t arg)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc = (iwk_sc_t *)arg;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t r, rfh;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_glock);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx
d62cb7fff63265824a8e6725a3bcef698f6134c9hx if (sc->sc_flags & IWK_F_SUSPEND) {
d62cb7fff63265824a8e6725a3bcef698f6134c9hx mutex_exit(&sc->sc_glock);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx return (DDI_INTR_UNCLAIMED);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx }
d62cb7fff63265824a8e6725a3bcef698f6134c9hx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx r = IWK_READ(sc, CSR_INT);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (r == 0 || r == 0xffffffff) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_INTR_UNCLAIMED);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_INTR, "interrupt reg %x\n", r));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rfh = IWK_READ(sc, CSR_FH_INT_STATUS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_INTR, "FH interrupt reg %x\n", rfh));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* disable interrupts */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_INT_MASK, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* ack interrupts */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_INT, r);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_FH_INT_STATUS, rfh);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (sc->sc_rx_softint_id == NULL) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_INTR_CLAIMED);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (r & (BIT_INT_SWERROR | BIT_INT_ERR)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_FW, "fatal firmware error\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_stop(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_ostate = sc->sc_ic.ic_state;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_new_state(&sc->sc_ic, IEEE80211_S_INIT, -1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_flags |= IWK_F_HW_ERR_RECOVER;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_INTR_CLAIMED);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (r & BIT_INT_RF_KILL) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_RADIO, "RF kill\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((r & (BIT_INT_FH_RX | BIT_INT_SW_RX)) ||
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (rfh & FH_INT_RX_MASK)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_rx_softint_pending = 1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_trigger_softintr(sc->sc_rx_softint_id);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (r & BIT_INT_ALIVE) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_FW, "firmware initialized.\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* re-enable interrupts */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_INT_MASK, CSR_INI_SET_MASK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (DDI_INTR_CLAIMED);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic uint8_t
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_rate_to_plcp(int rate)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint8_t ret;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx switch (rate) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* CCK rates */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case 2:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0xa;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case 4:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0x14;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case 11:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0x37;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case 22:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0x6e;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* OFDM rates */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case 12:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0xd;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case 18:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0xf;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case 24:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0x5;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case 36:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0x7;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case 48:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0x9;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case 72:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0xb;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case 96:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0x1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case 108:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0x3;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx default:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ret = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (ret);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic mblk_t *
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_m_tx(void *arg, mblk_t *mp)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc = (iwk_sc_t *)arg;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mblk_t *next;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
d62cb7fff63265824a8e6725a3bcef698f6134c9hx if (sc->sc_flags & IWK_F_SUSPEND) {
d62cb7fff63265824a8e6725a3bcef698f6134c9hx freemsgchain(mp);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx return (NULL);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx }
d62cb7fff63265824a8e6725a3bcef698f6134c9hx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_state != IEEE80211_S_RUN) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx freemsgchain(mp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (NULL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx while (mp != NULL) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx next = mp->b_next;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mp->b_next = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (iwk_send(ic, mp, IEEE80211_FC0_TYPE_DATA) != 0) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mp->b_next = next;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mp = next;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (mp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/* ARGSUSED */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_send(ieee80211com_t *ic, mblk_t *mp, uint8_t type)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc = (iwk_sc_t *)ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_ring_t *ring;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_desc_t *desc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_data_t *data;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_cmd_t *cmd;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_cmd_t *tx;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_node_t *in;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx struct ieee80211_frame *wh;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx struct ieee80211_key *k = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mblk_t *m, *m0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int rate, hdrlen, len, len0, mblen, off, err = IWK_SUCCESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint16_t masks = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring = &sc->sc_txq[0];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx data = &ring->data[ring->cur];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc = data->desc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd = data->cmd;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx bzero(desc, sizeof (*desc));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx bzero(cmd, sizeof (*cmd));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_tx_lock);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx if (sc->sc_flags & IWK_F_SUSPEND) {
d62cb7fff63265824a8e6725a3bcef698f6134c9hx mutex_exit(&sc->sc_tx_lock);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx if ((type & IEEE80211_FC0_TYPE_MASK) !=
d62cb7fff63265824a8e6725a3bcef698f6134c9hx IEEE80211_FC0_TYPE_DATA) {
d62cb7fff63265824a8e6725a3bcef698f6134c9hx freemsg(mp);
d62cb7fff63265824a8e6725a3bcef698f6134c9hx }
d62cb7fff63265824a8e6725a3bcef698f6134c9hx err = IWK_FAIL;
d62cb7fff63265824a8e6725a3bcef698f6134c9hx goto exit;
d62cb7fff63265824a8e6725a3bcef698f6134c9hx }
d62cb7fff63265824a8e6725a3bcef698f6134c9hx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ring->queued > ring->count - 64) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_TX, "iwk_send(): no txbuf\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_need_reschedule = 1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_tx_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((type & IEEE80211_FC0_TYPE_MASK) !=
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_FC0_TYPE_DATA) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx freemsg(mp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_tx_nobuf++;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = IWK_FAIL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto exit;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_tx_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdrlen = sizeof (struct ieee80211_frame);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx m = allocb(msgdsize(mp) + 32, BPRI_MED);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (m == NULL) { /* can not alloc buf, drop this package */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_send(): failed to allocate msgbuf\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx freemsg(mp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = IWK_SUCCESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto exit;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (off = 0, m0 = mp; m0 != NULL; m0 = m0->b_cont) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mblen = MBLKL(m0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(m->b_rptr + off, m0->b_rptr, mblen);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx off += mblen;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx m->b_wptr += off;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx freemsg(mp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx wh = (struct ieee80211_frame *)m->b_rptr;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx in = ieee80211_find_txnode(ic, wh->i_addr1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (in == NULL) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_send(): failed to find tx node\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx freemsg(m);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_tx_err++;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = IWK_SUCCESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto exit;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) ieee80211_encap(ic, m, in);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd->hdr.type = REPLY_TX;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd->hdr.flags = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd->hdr.qid = ring->qid;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd->hdr.idx = ring->cur;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx = (iwk_tx_cmd_t *)cmd->data;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->tx_flags = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (IEEE80211_IS_MULTICAST(wh->i_addr1)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->tx_flags &= ~(LE_32(TX_CMD_FLG_ACK_MSK));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx } else {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->tx_flags |= LE_32(TX_CMD_FLG_ACK_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx k = ieee80211_crypto_encap(ic, m);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (k == NULL) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx freemsg(m);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_tx_err++;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = IWK_SUCCESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto exit;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (k->wk_cipher->ic_cipher == IEEE80211_CIPHER_AES_CCM) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->sec_ctl = 2; /* for CCMP */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->tx_flags |= LE_32(TX_CMD_FLG_ACK_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(&tx->key, k->wk_key, k->wk_keylen);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* packet header may have moved, reset our local pointer */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx wh = (struct ieee80211_frame *)m->b_rptr;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx len = msgdsize(m);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#ifdef DEBUG
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (iwk_dbg_flags & IWK_DEBUG_TX)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_dump_pkt((uint8_t *)wh, hdrlen, 0, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx#endif
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* pickup a rate */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) ==
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_FC0_TYPE_MGT) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* mgmt frames are sent at 1M */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rate = in->in_rates.ir_rates[0];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx } else {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
43439c96b8398c01c375889c79bed72d78fb4c39hx * do it here for the software way rate control.
43439c96b8398c01c375889c79bed72d78fb4c39hx * later for rate scaling in hardware.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * maybe like the following, for management frame:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * tx->initial_rate_index = LINK_QUAL_MAX_RETRY_NUM - 1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * for data frame:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * tx->tx_flags |= (LE_32(TX_CMD_FLG_STA_RATE_MSK));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * rate = in->in_rates.ir_rates[in->in_txrate];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * tx->initial_rate_index = 1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * now the txrate is determined in tx cmd flags, set to the
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * max value 54M for 11g and 11M for 11b.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_fixed_rate != IEEE80211_FIXED_RATE_NONE) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rate = ic->ic_fixed_rate;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx } else {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rate = in->in_rates.ir_rates[in->in_txrate];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rate &= IEEE80211_RATE_VAL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_TX, "tx rate[%d of %d] = %x",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx in->in_txrate, in->in_rates.ir_nrates, rate));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->tx_flags |= (LE_32(TX_CMD_FLG_SEQ_CTL_MSK));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx len0 = roundup(4 + sizeof (iwk_tx_cmd_t) + hdrlen, 4);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (len0 != (4 + sizeof (iwk_tx_cmd_t) + hdrlen))
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->tx_flags |= TX_CMD_FLG_MH_PAD_MSK;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* retrieve destination node's id */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (IEEE80211_IS_MULTICAST(wh->i_addr1)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->sta_id = IWK_BROADCAST_ID;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx } else {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->sta_id = IWK_AP_ID;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) ==
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_FC0_TYPE_MGT) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* tell h/w to set timestamp in probe responses */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) ==
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_FC0_SUBTYPE_PROBE_RESP)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->tx_flags |= LE_32(TX_CMD_FLG_TSF_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (((wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) ==
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_FC0_SUBTYPE_ASSOC_REQ) ||
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ((wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) ==
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_FC0_SUBTYPE_REASSOC_REQ))
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->timeout.pm_frame_timeout = 3;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx else
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->timeout.pm_frame_timeout = 2;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx } else
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->timeout.pm_frame_timeout = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (rate == 2 || rate == 4 || rate == 11 || rate == 22)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx masks |= RATE_MCS_CCK_MSK;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx masks |= RATE_MCS_ANT_B_MSK;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->rate.r.rate_n_flags = (iwk_rate_to_plcp(rate) | masks);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_TX, "tx flag = %x",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->tx_flags));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->rts_retry_limit = 60;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->data_retry_limit = 15;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->stop_time.life_time = LE_32(0xffffffff);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->len = LE_16(len);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->dram_lsb_ptr =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx data->paddr_cmd + 4 + offsetof(iwk_tx_cmd_t, scratch);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->dram_msb_ptr = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->driver_txop = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tx->next_frame_len = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(tx + 1, m->b_rptr, hdrlen);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx m->b_rptr += hdrlen;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(data->dma_data.mem_va, m->b_rptr, len - hdrlen);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_TX, "sending data: qid=%d idx=%d len=%d",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->qid, ring->cur, len));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * first segment includes the tx cmd plus the 802.11 header,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * the second includes the remaining of the 802.11 frame.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->val0 = LE_32(2 << 24);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->pa[0].tb1_addr = LE_32(data->paddr_cmd);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->pa[0].val1 = ((len0 << 4) & 0xfff0) |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ((data->dma_data.cookie.dmac_address & 0xffff) << 16);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->pa[0].val2 =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ((data->dma_data.cookie.dmac_address & 0xffff0000) >> 16) |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ((len - hdrlen) << 20);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_TX, "phy addr1 = 0x%x phy addr2 = 0x%x "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "len1 = 0x%x, len2 = 0x%x val1 = 0x%x val2 = 0x%x",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx data->paddr_cmd, data->dma_data.cookie.dmac_address,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx len0, len - hdrlen, desc->pa[0].val1, desc->pa[0].val2));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_tx_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->queued++;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_tx_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* kick ring */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_shared->queues_byte_cnt_tbls[ring->qid].tfd_offset[ring->cur].val
c533a883a71cff9ff32df1c53c31201e1cbf371fhx = 8 + len;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ring->cur < IWK_MAX_WIN_SIZE) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_shared->queues_byte_cnt_tbls[ring->qid].
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tfd_offset[IWK_QUEUE_SIZE + ring->cur].val = 8 + len;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DMA_SYNC(data->dma_data, DDI_DMA_SYNC_FORDEV);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DMA_SYNC(ring->dma_desc, DDI_DMA_SYNC_FORDEV);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->cur = (ring->cur + 1) % ring->count;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, HBUS_TARG_WRPTR, ring->qid << 8 | ring->cur);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx freemsg(m);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* release node reference */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_free_node(in);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_stats.is_tx_bytes += len;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_stats.is_tx_frags++;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (sc->sc_tx_timer == 0)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_tx_timer = 10;
c533a883a71cff9ff32df1c53c31201e1cbf371fhxexit:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_m_ioctl(void* arg, queue_t *wq, mblk_t *mp)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc = (iwk_sc_t *)arg;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int err;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = ieee80211_ioctl(ic, wq, mp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err == ENETRESET) {
43439c96b8398c01c375889c79bed72d78fb4c39hx /*
43439c96b8398c01c375889c79bed72d78fb4c39hx * This is special for the hidden AP connection.
43439c96b8398c01c375889c79bed72d78fb4c39hx * In any case, we should make sure only one 'scan'
43439c96b8398c01c375889c79bed72d78fb4c39hx * in the driver for a 'connect' CLI command. So
43439c96b8398c01c375889c79bed72d78fb4c39hx * when connecting to a hidden AP, the scan is just
43439c96b8398c01c375889c79bed72d78fb4c39hx * sent out to the air when we know the desired
43439c96b8398c01c375889c79bed72d78fb4c39hx * essid of the AP we want to connect.
43439c96b8398c01c375889c79bed72d78fb4c39hx */
43439c96b8398c01c375889c79bed72d78fb4c39hx if (ic->ic_des_esslen) {
43439c96b8398c01c375889c79bed72d78fb4c39hx (void) ieee80211_new_state(ic,
43439c96b8398c01c375889c79bed72d78fb4c39hx IEEE80211_S_SCAN, -1);
43439c96b8398c01c375889c79bed72d78fb4c39hx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*ARGSUSED*/
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_m_stat(void *arg, uint_t stat, uint64_t *val)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc = (iwk_sc_t *)arg;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_node_t *in = ic->ic_bss;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx struct ieee80211_rateset *rs = &in->in_rates;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx switch (stat) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case MAC_STAT_IFSPEED:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *val = ((ic->ic_fixed_rate == IEEE80211_FIXED_RATE_NONE) ?
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (rs->ir_rates[in->in_txrate] & IEEE80211_RATE_VAL)
020c47705d28102a8df83a43ddf08e34dde21f22ql : ic->ic_fixed_rate) /2 * 1000000;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case MAC_STAT_NOXMTBUF:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *val = sc->sc_tx_nobuf;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case MAC_STAT_NORCVBUF:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *val = sc->sc_rx_nobuf;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case MAC_STAT_IERRORS:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *val = sc->sc_rx_err;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case MAC_STAT_RBYTES:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *val = ic->ic_stats.is_rx_bytes;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case MAC_STAT_IPACKETS:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *val = ic->ic_stats.is_rx_frags;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case MAC_STAT_OBYTES:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *val = ic->ic_stats.is_tx_bytes;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case MAC_STAT_OPACKETS:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *val = ic->ic_stats.is_tx_frags;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case MAC_STAT_OERRORS:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case WIFI_STAT_TX_FAILED:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *val = sc->sc_tx_err;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case WIFI_STAT_TX_RETRANS:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *val = sc->sc_tx_retries;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case WIFI_STAT_FCS_ERRORS:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case WIFI_STAT_WEP_ERRORS:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case WIFI_STAT_TX_FRAGS:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case WIFI_STAT_MCAST_TX:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case WIFI_STAT_RTS_SUCCESS:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case WIFI_STAT_RTS_FAILURE:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case WIFI_STAT_ACK_FAILURE:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case WIFI_STAT_RX_FRAGS:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case WIFI_STAT_MCAST_RX:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case WIFI_STAT_RX_DUPS:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (ieee80211_stat(ic, stat, val));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx default:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (ENOTSUP);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_m_start(void *arg)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc = (iwk_sc_t *)arg;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int err;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_init(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
43439c96b8398c01c375889c79bed72d78fb4c39hx /*
43439c96b8398c01c375889c79bed72d78fb4c39hx * The hw init err(eg. RF is OFF). Return Success to make
43439c96b8398c01c375889c79bed72d78fb4c39hx * the 'plumb' succeed. The iwk_thread() tries to re-init
43439c96b8398c01c375889c79bed72d78fb4c39hx * background.
43439c96b8398c01c375889c79bed72d78fb4c39hx */
43439c96b8398c01c375889c79bed72d78fb4c39hx mutex_enter(&sc->sc_glock);
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_flags |= IWK_F_HW_ERR_RECOVER;
43439c96b8398c01c375889c79bed72d78fb4c39hx mutex_exit(&sc->sc_glock);
43439c96b8398c01c375889c79bed72d78fb4c39hx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
43439c96b8398c01c375889c79bed72d78fb4c39hx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
43439c96b8398c01c375889c79bed72d78fb4c39hx mutex_enter(&sc->sc_glock);
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_flags |= IWK_F_RUNNING;
43439c96b8398c01c375889c79bed72d78fb4c39hx mutex_exit(&sc->sc_glock);
43439c96b8398c01c375889c79bed72d78fb4c39hx
43439c96b8398c01c375889c79bed72d78fb4c39hx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_m_stop(void *arg)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc = (iwk_sc_t *)arg;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_stop(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_mt_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_flags &= ~IWK_F_HW_ERR_RECOVER;
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_flags &= ~IWK_F_RATE_AUTO_CTL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_mt_lock);
43439c96b8398c01c375889c79bed72d78fb4c39hx mutex_enter(&sc->sc_glock);
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_flags &= ~IWK_F_RUNNING;
43439c96b8398c01c375889c79bed72d78fb4c39hx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*ARGSUSED*/
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_m_unicst(void *arg, const uint8_t *macaddr)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_sc_t *sc = (iwk_sc_t *)arg;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int err;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (!IEEE80211_ADDR_EQ(ic->ic_macaddr, macaddr)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_ADDR_COPY(ic->ic_macaddr, macaddr);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_config(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_m_unicst(): "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "failed to configure device\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhxfail:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*ARGSUSED*/
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_m_multicst(void *arg, boolean_t add, const uint8_t *m)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*ARGSUSED*/
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_m_promisc(void *arg, boolean_t on)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_thread(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
43439c96b8398c01c375889c79bed72d78fb4c39hx clock_t clk;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int times = 0, err, n = 0, timeout = 0;
43439c96b8398c01c375889c79bed72d78fb4c39hx uint32_t tmp;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_mt_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx while (sc->sc_mf_thread_switch) {
43439c96b8398c01c375889c79bed72d78fb4c39hx tmp = IWK_READ(sc, CSR_GP_CNTRL);
43439c96b8398c01c375889c79bed72d78fb4c39hx if (tmp & CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW) {
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_flags &= ~IWK_F_RADIO_OFF;
43439c96b8398c01c375889c79bed72d78fb4c39hx } else {
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_flags |= IWK_F_RADIO_OFF;
43439c96b8398c01c375889c79bed72d78fb4c39hx }
43439c96b8398c01c375889c79bed72d78fb4c39hx /*
d62cb7fff63265824a8e6725a3bcef698f6134c9hx * If in SUSPEND or the RF is OFF, do nothing
43439c96b8398c01c375889c79bed72d78fb4c39hx */
d62cb7fff63265824a8e6725a3bcef698f6134c9hx if ((sc->sc_flags & IWK_F_SUSPEND) ||
d62cb7fff63265824a8e6725a3bcef698f6134c9hx (sc->sc_flags & IWK_F_RADIO_OFF)) {
43439c96b8398c01c375889c79bed72d78fb4c39hx mutex_exit(&sc->sc_mt_lock);
43439c96b8398c01c375889c79bed72d78fb4c39hx delay(drv_usectohz(100000));
43439c96b8398c01c375889c79bed72d78fb4c39hx mutex_enter(&sc->sc_mt_lock);
43439c96b8398c01c375889c79bed72d78fb4c39hx continue;
43439c96b8398c01c375889c79bed72d78fb4c39hx }
43439c96b8398c01c375889c79bed72d78fb4c39hx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * recovery fatal error
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_mach &&
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (sc->sc_flags & IWK_F_HW_ERR_RECOVER)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_FW,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_thread(): "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "try to recover fatal hw error: %d\n", times++));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_stop(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_mt_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx delay(drv_usectohz(2000000 + n*500000));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_mt_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_init(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx n++;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (n < 20)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx continue;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx n = 0;
43439c96b8398c01c375889c79bed72d78fb4c39hx if (!err)
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_flags |= IWK_F_RUNNING;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_flags &= ~IWK_F_HW_ERR_RECOVER;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_mt_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx delay(drv_usectohz(2000000));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (sc->sc_ostate != IEEE80211_S_INIT)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_new_state(ic, IEEE80211_S_SCAN, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_mt_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
43439c96b8398c01c375889c79bed72d78fb4c39hx /*
43439c96b8398c01c375889c79bed72d78fb4c39hx * rate ctl
43439c96b8398c01c375889c79bed72d78fb4c39hx */
43439c96b8398c01c375889c79bed72d78fb4c39hx if (ic->ic_mach &&
43439c96b8398c01c375889c79bed72d78fb4c39hx (sc->sc_flags & IWK_F_RATE_AUTO_CTL)) {
43439c96b8398c01c375889c79bed72d78fb4c39hx clk = ddi_get_lbolt();
43439c96b8398c01c375889c79bed72d78fb4c39hx if (clk > sc->sc_clk + drv_usectohz(500000)) {
43439c96b8398c01c375889c79bed72d78fb4c39hx iwk_amrr_timeout(sc);
43439c96b8398c01c375889c79bed72d78fb4c39hx }
43439c96b8398c01c375889c79bed72d78fb4c39hx }
43439c96b8398c01c375889c79bed72d78fb4c39hx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_mt_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx delay(drv_usectohz(100000));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_mt_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (sc->sc_tx_timer) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx timeout++;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (timeout == 10) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_tx_timer--;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (sc->sc_tx_timer == 0) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_flags |= IWK_F_HW_ERR_RECOVER;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_ostate = IEEE80211_S_RUN;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_FW,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_thread(): try to recover from"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " 'send fail\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx timeout = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_mf_thread = NULL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cv_signal(&sc->sc_mt_cv);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_mt_lock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Send a command to the firmware.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_cmd(iwk_sc_t *sc, int code, const void *buf, int size, int async)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_ring_t *ring = &sc->sc_txq[IWK_CMD_QUEUE_NUM];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_desc_t *desc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_cmd_t *cmd;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ASSERT(size <= sizeof (cmd->data));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ASSERT(mutex_owned(&sc->sc_glock));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_CMD, "iwk_cmd() code[%d]", code));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc = ring->data[ring->cur].desc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd = ring->data[ring->cur].cmd;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd->hdr.type = (uint8_t)code;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd->hdr.flags = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd->hdr.qid = ring->qid;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd->hdr.idx = ring->cur;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(cmd->data, buf, size);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(desc, 0, sizeof (*desc));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->val0 = LE_32(1 << 24);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->pa[0].tb1_addr =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (uint32_t)(ring->data[ring->cur].paddr_cmd & 0xffffffff);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->pa[0].val1 = ((4 + size) << 4) & 0xfff0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* kick cmd ring XXX */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_shared->queues_byte_cnt_tbls[ring->qid]
c533a883a71cff9ff32df1c53c31201e1cbf371fhx .tfd_offset[ring->cur].val = 8;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ring->cur < IWK_MAX_WIN_SIZE) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_shared->queues_byte_cnt_tbls[ring->qid]
c533a883a71cff9ff32df1c53c31201e1cbf371fhx .tfd_offset[IWK_QUEUE_SIZE + ring->cur].val = 8;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->cur = (ring->cur + 1) % ring->count;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, HBUS_TARG_WRPTR, ring->qid << 8 | ring->cur);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (async)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx else {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx clock_t clk;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_flags &= ~IWK_F_CMD_DONE;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx clk = ddi_get_lbolt() + drv_usectohz(2000000);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx while (!(sc->sc_flags & IWK_F_CMD_DONE)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (cv_timedwait(&sc->sc_cmd_cv, &sc->sc_glock, clk)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx < 0)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (sc->sc_flags & IWK_F_CMD_DONE)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx else
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_FAIL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_set_led(iwk_sc_t *sc, uint8_t id, uint8_t off, uint8_t on)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_led_cmd_t led;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx led.interval = LE_32(100000); /* unit: 100ms */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx led.id = id;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx led.off = off;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx led.on = on;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) iwk_cmd(sc, REPLY_LEDS_CMD, &led, sizeof (led), 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_hw_set_before_auth(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_node_t *in = ic->ic_bss;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_power_table_cmd_t txpower;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_add_sta_t node;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_link_quality_cmd_t link_quality;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx struct ieee80211_rateset rs;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint16_t masks = 0, rate;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i, err;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* update adapter's configuration according the info of target AP */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_ADDR_COPY(sc->sc_config.bssid, in->in_bssid);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.chan = ieee80211_chan2ieee(ic, in->in_chan);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_curmode == IEEE80211_MODE_11B) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.cck_basic_rates = 0x03;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.ofdm_basic_rates = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx } else if ((in->in_chan != IEEE80211_CHAN_ANYC) &&
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (IEEE80211_IS_CHAN_5GHZ(in->in_chan))) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.cck_basic_rates = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.ofdm_basic_rates = 0x15;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx } else { /* assume 802.11b/g */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.cck_basic_rates = 0x0f;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.ofdm_basic_rates = 0xff;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.flags &= ~LE_32(RXON_FLG_SHORT_PREAMBLE_MSK |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx RXON_FLG_SHORT_SLOT_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_flags & IEEE80211_F_SHSLOT)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.flags |= LE_32(RXON_FLG_SHORT_SLOT_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx else
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.flags &= LE_32(~RXON_FLG_SHORT_SLOT_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_flags & IEEE80211_F_SHPREAMBLE)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.flags |= LE_32(RXON_FLG_SHORT_PREAMBLE_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx else
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.flags &= LE_32(~RXON_FLG_SHORT_PREAMBLE_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_80211, "config chan %d flags %x "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "filter_flags %x cck %x ofdm %x"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " bssid:%02x:%02x:%02x:%02x:%02x:%2x\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.chan, sc->sc_config.flags,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.filter_flags,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.cck_basic_rates, sc->sc_config.ofdm_basic_rates,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.bssid[0], sc->sc_config.bssid[1],
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.bssid[2], sc->sc_config.bssid[3],
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.bssid[4], sc->sc_config.bssid[5]));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, REPLY_RXON, &sc->sc_config,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (iwk_rxon_cmd_t), 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_hw_set_before_auth():"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " failed to config chan%d\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.chan);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * set Tx power for 2.4GHz channels
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * (need further investigation. fix tx power at present)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(&txpower, 0, sizeof (txpower));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.band = 1; /* for 2.4G */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.channel = sc->sc_config.chan;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.channel_normal_width = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < POWER_TABLE_NUM_HT_OFDM_ENTRIES; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.tx_power.ht_ofdm_power[i].s
c533a883a71cff9ff32df1c53c31201e1cbf371fhx .ramon_tx_gain = 0x3f3f;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.tx_power.ht_ofdm_power[i].s
c533a883a71cff9ff32df1c53c31201e1cbf371fhx .dsp_predis_atten = 110 | (110 << 8);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.tx_power.ht_ofdm_power[POWER_TABLE_NUM_HT_OFDM_ENTRIES].
c533a883a71cff9ff32df1c53c31201e1cbf371fhx s.ramon_tx_gain = 0x3f3f;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.tx_power.ht_ofdm_power[POWER_TABLE_NUM_HT_OFDM_ENTRIES].
c533a883a71cff9ff32df1c53c31201e1cbf371fhx s.dsp_predis_atten = 110 | (110 << 8);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, REPLY_TX_PWR_TABLE_CMD, &txpower,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (txpower), 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_hw_set_before_auth():"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " failed to set txpower\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* add default AP node */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(&node, 0, sizeof (node));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_ADDR_COPY(node.bssid, in->in_bssid);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx node.id = IWK_AP_ID;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, REPLY_ADD_STA, &node, sizeof (node), 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_hw_set_before_auth():"
c533a883a71cff9ff32df1c53c31201e1cbf371fhx " failed to add BSS node\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* TX_LINK_QUALITY cmd ? */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(&link_quality, 0, sizeof (link_quality));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rs = ic->ic_sup_rates[ieee80211_chan2mode(ic, ic->ic_curchan)];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < LINK_QUAL_MAX_RETRY_NUM; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (i < rs.ir_nrates)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rate = rs.ir_rates[rs.ir_nrates - i];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx else
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rate = 2;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (rate == 2 || rate == 4 || rate == 11 || rate == 22)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx masks |= RATE_MCS_CCK_MSK;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx masks |= RATE_MCS_ANT_B_MSK;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx masks &= ~RATE_MCS_ANT_A_MSK;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx link_quality.rate_n_flags[i] =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_rate_to_plcp(rate) | masks;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx link_quality.general_params.single_stream_ant_msk = 2;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx link_quality.general_params.dual_stream_ant_msk = 3;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx link_quality.agg_params.agg_dis_start_th = 3;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx link_quality.agg_params.agg_time_limit = LE_16(4000);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx link_quality.sta_id = IWK_AP_ID;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, REPLY_TX_LINK_QUALITY_CMD, &link_quality,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (link_quality), 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_hw_set_before_auth(): "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "failed to config link quality table\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * Send a scan request(assembly scan cmd) to the firmware.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_scan(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_ring_t *ring = &sc->sc_txq[IWK_CMD_QUEUE_NUM];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_desc_t *desc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_data_t *data;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_cmd_t *cmd;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_scan_hdr_t *hdr;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_scan_chan_t *chan;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx struct ieee80211_frame *wh;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211_node_t *in = ic->ic_bss;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx struct ieee80211_rateset *rs;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx enum ieee80211_phymode mode;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint8_t *frm;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i, pktlen, nrates;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx data = &ring->data[ring->cur];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc = data->desc;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd = (iwk_cmd_t *)data->dma_data.mem_va;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd->hdr.type = REPLY_SCAN_CMD;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd->hdr.flags = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd->hdr.qid = ring->qid;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmd->hdr.idx = ring->cur | 0x40;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr = (iwk_scan_hdr_t *)cmd->data;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(hdr, 0, sizeof (iwk_scan_hdr_t));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->nchan = 11;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->quiet_time = LE_16(5);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->quiet_plcp_th = LE_16(1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->flags = RXON_FLG_BAND_24G_MSK | RXON_FLG_AUTO_DETECT_MSK;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->rx_chain = RXON_RX_CHAIN_DRIVER_FORCE_MSK |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx LE_16((0x7 << RXON_RX_CHAIN_VALID_POS) |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (0x6 << RXON_RX_CHAIN_FORCE_SEL_POS) |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (0x7 << RXON_RX_CHAIN_FORCE_MIMO_SEL_POS));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->tx_cmd.tx_flags = TX_CMD_FLG_SEQ_CTL_MSK;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->tx_cmd.sta_id = IWK_BROADCAST_ID;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->tx_cmd.stop_time.life_time = 0xffffffff;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->tx_cmd.tx_flags |= (0x200);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->tx_cmd.rate.r.rate_n_flags = iwk_rate_to_plcp(2);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->tx_cmd.rate.r.rate_n_flags |=
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (RATE_MCS_ANT_B_MSK|RATE_MCS_CCK_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->direct_scan[0].len = ic->ic_des_esslen;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->direct_scan[0].id = IEEE80211_ELEMID_SSID;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_des_esslen)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx bcopy(ic->ic_des_essid, hdr->direct_scan[0].ssid,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_des_esslen);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx else
c533a883a71cff9ff32df1c53c31201e1cbf371fhx bzero(hdr->direct_scan[0].ssid,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (hdr->direct_scan[0].ssid));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * a probe request frame is required after the REPLY_SCAN_CMD
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx wh = (struct ieee80211_frame *)(hdr + 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx wh->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_MGT |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_FC0_SUBTYPE_PROBE_REQ;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx wh->i_fc[1] = IEEE80211_FC1_DIR_NODS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(wh->i_addr1, 0xff, 6);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_ADDR_COPY(wh->i_addr2, ic->ic_macaddr);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(wh->i_addr3, 0xff, 6);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *(uint16_t *)&wh->i_dur[0] = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *(uint16_t *)&wh->i_seq[0] = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx frm = (uint8_t *)(wh + 1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* essid IE */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *frm++ = IEEE80211_ELEMID_SSID;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *frm++ = in->in_esslen;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(frm, in->in_essid, in->in_esslen);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx frm += in->in_esslen;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mode = ieee80211_chan2mode(ic, ic->ic_curchan);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rs = &ic->ic_sup_rates[mode];
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* supported rates IE */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *frm++ = IEEE80211_ELEMID_RATES;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx nrates = rs->ir_nrates;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (nrates > IEEE80211_RATE_SIZE)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx nrates = IEEE80211_RATE_SIZE;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *frm++ = (uint8_t)nrates;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(frm, rs->ir_rates, nrates);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx frm += nrates;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* supported xrates IE */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (rs->ir_nrates > IEEE80211_RATE_SIZE) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx nrates = rs->ir_nrates - IEEE80211_RATE_SIZE;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *frm++ = IEEE80211_ELEMID_XRATES;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx *frm++ = (uint8_t)nrates;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(frm, rs->ir_rates + IEEE80211_RATE_SIZE, nrates);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx frm += nrates;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* optionnal IE (usually for wpa) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ic->ic_opt_ie != NULL) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(frm, ic->ic_opt_ie, ic->ic_opt_ie_len);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx frm += ic->ic_opt_ie_len;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* setup length of probe request */
ff3124eff995e6cd8ebd8c6543648e0670920034ff hdr->tx_cmd.len = LE_16(_PTRDIFF(frm, wh));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->len = hdr->nchan * sizeof (iwk_scan_chan_t) +
c533a883a71cff9ff32df1c53c31201e1cbf371fhx hdr->tx_cmd.len + sizeof (iwk_scan_hdr_t);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * the attribute of the scan channels are required after the probe
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * request frame.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx chan = (iwk_scan_chan_t *)frm;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 1; i <= hdr->nchan; i++, chan++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx chan->type = 3;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx chan->chan = (uint8_t)i;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx chan->tpc.tx_gain = 0x3f;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx chan->tpc.dsp_atten = 110;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx chan->active_dwell = LE_16(20);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx chan->passive_dwell = LE_16(120);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx frm += sizeof (iwk_scan_chan_t);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
ff3124eff995e6cd8ebd8c6543648e0670920034ff pktlen = _PTRDIFF(frm, cmd);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(desc, 0, sizeof (*desc));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->val0 = LE_32(1 << 24);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->pa[0].tb1_addr =
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (uint32_t)(data->dma_data.cookie.dmac_address & 0xffffffff);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx desc->pa[0].val1 = (pktlen << 4) & 0xfff0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * maybe for cmd, filling the byte cnt table is not necessary.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * anyway, we fill it here.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_shared->queues_byte_cnt_tbls[ring->qid]
c533a883a71cff9ff32df1c53c31201e1cbf371fhx .tfd_offset[ring->cur].val = 8;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (ring->cur < IWK_MAX_WIN_SIZE) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_shared->queues_byte_cnt_tbls[ring->qid]
c533a883a71cff9ff32df1c53c31201e1cbf371fhx .tfd_offset[IWK_QUEUE_SIZE + ring->cur].val = 8;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
43439c96b8398c01c375889c79bed72d78fb4c39hx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* kick cmd ring */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ring->cur = (ring->cur + 1) % ring->count;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, HBUS_TARG_WRPTR, ring->qid << 8 | ring->cur);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_config(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_tx_power_table_cmd_t txpower;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_powertable_cmd_t powertable;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_bt_cmd_t bt;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_add_sta_t node;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_link_quality_cmd_t link_quality;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i, err;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint16_t masks = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * set power mode. Disable power management at present, do it later
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(&powertable, 0, sizeof (powertable));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx powertable.flags = LE_16(0x8);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, POWER_TABLE_CMD, &powertable,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (powertable), 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_config(): failed to set power mode\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* configure bt coexistence */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(&bt, 0, sizeof (bt));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx bt.flags = 3;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx bt.lead_time = 0xaa;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx bt.max_kill = 1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, REPLY_BT_CONFIG, &bt,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (bt), 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_config(): "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "failed to configurate bt coexistence\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* configure rxon */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(&sc->sc_config, 0, sizeof (iwk_rxon_cmd_t));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_ADDR_COPY(sc->sc_config.node_addr, ic->ic_macaddr);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_ADDR_COPY(sc->sc_config.wlap_bssid, ic->ic_macaddr);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.chan = ieee80211_chan2ieee(ic, ic->ic_curchan);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.flags = (RXON_FLG_TSF2HOST_MSK | RXON_FLG_AUTO_DETECT_MSK
c533a883a71cff9ff32df1c53c31201e1cbf371fhx | RXON_FLG_BAND_24G_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.flags &= (~RXON_FLG_CCK_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx switch (ic->ic_opmode) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_M_STA:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.dev_type = RXON_DEV_TYPE_ESS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.filter_flags |= LE_32(RXON_FILTER_ACCEPT_GRP_MSK |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx RXON_FILTER_DIS_DECRYPT_MSK |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx RXON_FILTER_DIS_GRP_DECRYPT_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_M_IBSS:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_M_AHDEMO:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.dev_type = RXON_DEV_TYPE_IBSS;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_M_HOSTAP:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.dev_type = RXON_DEV_TYPE_AP;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx case IEEE80211_M_MONITOR:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.dev_type = RXON_DEV_TYPE_SNIFFER;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.filter_flags |= LE_32(RXON_FILTER_ACCEPT_GRP_MSK |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx RXON_FILTER_CTL2HOST_MSK | RXON_FILTER_PROMISC_MSK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.cck_basic_rates = 0x0f;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.ofdm_basic_rates = 0xff;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.ofdm_ht_single_stream_basic_rates = 0xff;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.ofdm_ht_dual_stream_basic_rates = 0xff;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* set antenna */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_config.rx_chain = RXON_RX_CHAIN_DRIVER_FORCE_MSK |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx LE_16((0x7 << RXON_RX_CHAIN_VALID_POS) |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (0x6 << RXON_RX_CHAIN_FORCE_SEL_POS) |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (0x7 << RXON_RX_CHAIN_FORCE_MIMO_SEL_POS));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, REPLY_RXON, &sc->sc_config,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (iwk_rxon_cmd_t), 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_config(): "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "failed to set configure command\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * set Tx power for 2.4GHz channels
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * (need further investigation. fix tx power at present)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(&txpower, 0, sizeof (txpower));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.band = 1; /* for 2.4G */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.channel = sc->sc_config.chan;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.channel_normal_width = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < POWER_TABLE_NUM_HT_OFDM_ENTRIES; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.tx_power.ht_ofdm_power[i]
c533a883a71cff9ff32df1c53c31201e1cbf371fhx .s.ramon_tx_gain = 0x3f3f;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.tx_power.ht_ofdm_power[i]
c533a883a71cff9ff32df1c53c31201e1cbf371fhx .s.dsp_predis_atten = 110 | (110 << 8);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.tx_power.ht_ofdm_power[POWER_TABLE_NUM_HT_OFDM_ENTRIES]
c533a883a71cff9ff32df1c53c31201e1cbf371fhx .s.ramon_tx_gain = 0x3f3f;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx txpower.tx_power.ht_ofdm_power[POWER_TABLE_NUM_HT_OFDM_ENTRIES]
c533a883a71cff9ff32df1c53c31201e1cbf371fhx .s.dsp_predis_atten = 110 | (110 << 8);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, REPLY_TX_PWR_TABLE_CMD, &txpower,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (txpower), 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_config(): failed to set txpower\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* add broadcast node so that we can send broadcast frame */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(&node, 0, sizeof (node));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(node.bssid, 0xff, 6);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx node.id = IWK_BROADCAST_ID;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, REPLY_ADD_STA, &node, sizeof (node), 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_config(): "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "failed to add broadcast node\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* TX_LINK_QUALITY cmd ? */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memset(&link_quality, 0, sizeof (link_quality));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < LINK_QUAL_MAX_RETRY_NUM; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx masks |= RATE_MCS_CCK_MSK;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx masks |= RATE_MCS_ANT_B_MSK;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx masks &= ~RATE_MCS_ANT_A_MSK;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx link_quality.rate_n_flags[i] = iwk_rate_to_plcp(2) | masks;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx link_quality.general_params.single_stream_ant_msk = 2;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx link_quality.general_params.dual_stream_ant_msk = 3;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx link_quality.agg_params.agg_dis_start_th = 3;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx link_quality.agg_params.agg_time_limit = LE_16(4000);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx link_quality.sta_id = IWK_BROADCAST_ID;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_cmd(sc, REPLY_TX_LINK_QUALITY_CMD, &link_quality,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sizeof (link_quality), 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_config(): "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "failed to config link quality table\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_stop_master(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t tmp;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int n;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = IWK_READ(sc, CSR_RESET);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_RESET, tmp | CSR_RESET_REG_FLAG_STOP_MASTER);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = IWK_READ(sc, CSR_GP_CNTRL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((tmp & CSR_GP_CNTRL_REG_MSK_POWER_SAVE_TYPE) ==
c533a883a71cff9ff32df1c53c31201e1cbf371fhx CSR_GP_CNTRL_REG_FLAG_MAC_POWER_SAVE)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (n = 0; n < 2000; n++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (IWK_READ(sc, CSR_RESET) &
c533a883a71cff9ff32df1c53c31201e1cbf371fhx CSR_RESET_REG_FLAG_MASTER_DISABLED)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(1000);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (n == 2000)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_HW,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "timeout waiting for master stop\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_power_up(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t tmp;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_enter(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = iwk_reg_read(sc, ALM_APMG_PS_CTL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp &= ~APMG_PS_CTRL_REG_MSK_POWER_SRC;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp |= APMG_PS_CTRL_REG_VAL_POWER_SRC_VMAIN;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, ALM_APMG_PS_CTL, tmp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_exit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(5000);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_preinit(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t tmp;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int n;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint8_t vlink;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* clear any pending interrupts */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_INT, 0xffffffff);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = IWK_READ(sc, CSR_GIO_CHICKEN_BITS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_GIO_CHICKEN_BITS,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp | CSR_GIO_CHICKEN_BITS_REG_BIT_DIS_L0S_EXIT_TIMER);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = IWK_READ(sc, CSR_GP_CNTRL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_GP_CNTRL, tmp | CSR_GP_CNTRL_REG_FLAG_INIT_DONE);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* wait for clock ready */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (n = 0; n < 1000; n++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (IWK_READ(sc, CSR_GP_CNTRL) &
c533a883a71cff9ff32df1c53c31201e1cbf371fhx CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(10);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (n == 1000) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (ETIMEDOUT);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_enter(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = iwk_reg_read(sc, APMG_CLK_CTRL_REG);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, APMG_CLK_CTRL_REG, tmp |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx APMG_CLK_REG_VAL_DMA_CLK_RQT | APMG_CLK_REG_VAL_BSM_CLK_RQT);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(20);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = iwk_reg_read(sc, ALM_APMG_PCIDEV_STT);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, ALM_APMG_PCIDEV_STT, tmp |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx APMG_DEV_STATE_REG_VAL_L1_ACTIVE_DISABLE);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_exit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_INT_COALESCING, 512 / 32); /* ??? */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) iwk_power_up(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((sc->sc_rev & 0x80) == 0x80 && (sc->sc_rev & 0x7f) < 8) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = ddi_get32(sc->sc_cfg_handle,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (uint32_t *)(sc->sc_cfg_base + 0xe8));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_put32(sc->sc_cfg_handle,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (uint32_t *)(sc->sc_cfg_base + 0xe8),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp & ~(1 << 11));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx vlink = ddi_get8(sc->sc_cfg_handle,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (uint8_t *)(sc->sc_cfg_base + 0xf0));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ddi_put8(sc->sc_cfg_handle, (uint8_t *)(sc->sc_cfg_base + 0xf0),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx vlink & ~2);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = IWK_READ(sc, CSR_SW_VER);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp |= CSR_HW_IF_CONFIG_REG_BIT_RADIO_SI |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx CSR_HW_IF_CONFIG_REG_BIT_MAC_SI | CSR_HW_IF_CONFIG_REG_BIT_KEDRON_R;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_SW_VER, tmp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* make sure power supply on each part of the hardware */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_enter(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = iwk_reg_read(sc, ALM_APMG_PS_CTL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp |= APMG_PS_CTRL_REG_VAL_ALM_R_RESET_REQ;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, ALM_APMG_PS_CTL, tmp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(5);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = iwk_reg_read(sc, ALM_APMG_PS_CTL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp &= ~APMG_PS_CTRL_REG_VAL_ALM_R_RESET_REQ;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, ALM_APMG_PS_CTL, tmp);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_exit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * set up semphore flag to own EEPROM
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_eep_sem_down(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int count1, count2;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t tmp;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (count1 = 0; count1 < 1000; count1++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = IWK_READ(sc, CSR_HW_IF_CONFIG_REG);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_HW_IF_CONFIG_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp | CSR_HW_IF_CONFIG_REG_EEP_SEM);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (count2 = 0; count2 < 2; count2++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (IWK_READ(sc, CSR_HW_IF_CONFIG_REG) &
c533a883a71cff9ff32df1c53c31201e1cbf371fhx CSR_HW_IF_CONFIG_REG_EEP_SEM)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(10000);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_FAIL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * reset semphore flag to release EEPROM
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_eep_sem_up(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t tmp;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = IWK_READ(sc, CSR_HW_IF_CONFIG_REG);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_HW_IF_CONFIG_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp & (~CSR_HW_IF_CONFIG_REG_EEP_SEM));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * This function load all infomation in eeprom into iwk_eep
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * structure in iwk_sc_t structure
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int iwk_eep_load(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i, rr;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t rv, tmp, eep_gp;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint16_t addr, eep_sz = sizeof (sc->sc_eep_map);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint16_t *eep_p = (uint16_t *)&sc->sc_eep_map;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* read eeprom gp register in CSR */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx eep_gp = IWK_READ(sc, CSR_EEPROM_GP);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if ((eep_gp & CSR_EEPROM_GP_VALID_MSK) ==
c533a883a71cff9ff32df1c53c31201e1cbf371fhx CSR_EEPROM_GP_BAD_SIGNATURE) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_EEPROM, "not find eeprom\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_FAIL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rr = iwk_eep_sem_down(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (rr != 0) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_EEPROM, "driver failed to own EEPROM\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_FAIL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (addr = 0; addr < eep_sz; addr += 2) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_EEPROM_REG, addr<<1);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = IWK_READ(sc, CSR_EEPROM_REG);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_EEPROM_REG, tmp & ~(0x2));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < 10; i++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx rv = IWK_READ(sc, CSR_EEPROM_REG);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (rv & 1)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(10);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (!(rv & 1)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_EEPROM,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "time out when read eeprome\n"));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_eep_sem_up(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_FAIL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx eep_p[addr/2] = rv >> 16;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_eep_sem_up(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx/*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * init mac address in ieee80211com_t struct
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void iwk_get_mac_from_eep(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ieee80211com_t *ic = &sc->sc_ic;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx struct iwk_eep *ep = &sc->sc_eep_map;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IEEE80211_ADDR_COPY(ic->ic_macaddr, ep->mac_address);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_DBG((IWK_DEBUG_EEPROM, "mac:%2x:%2x:%2x:%2x:%2x:%2x\n",
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_macaddr[0], ic->ic_macaddr[1], ic->ic_macaddr[2],
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ic->ic_macaddr[3], ic->ic_macaddr[4], ic->ic_macaddr[5]));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic int
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_init(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int qid, n, err;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx clock_t clk;
43439c96b8398c01c375889c79bed72d78fb4c39hx uint32_t tmp;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_flags &= ~IWK_F_FW_INIT;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) iwk_preinit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
43439c96b8398c01c375889c79bed72d78fb4c39hx tmp = IWK_READ(sc, CSR_GP_CNTRL);
43439c96b8398c01c375889c79bed72d78fb4c39hx if (!(tmp & CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW)) {
43439c96b8398c01c375889c79bed72d78fb4c39hx cmn_err(CE_WARN, "iwk_init(): Radio transmitter is off\n");
43439c96b8398c01c375889c79bed72d78fb4c39hx goto fail1;
43439c96b8398c01c375889c79bed72d78fb4c39hx }
43439c96b8398c01c375889c79bed72d78fb4c39hx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* init Rx ring */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_enter(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, FH_MEM_RCSR_CHNL0_CONFIG_REG, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, FH_RSCSR_CHNL0_RBDCB_WPTR_REG, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, FH_RSCSR_CHNL0_RBDCB_BASE_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_rxq.dma_desc.cookie.dmac_address >> 8);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, FH_RSCSR_CHNL0_STTS_WPTR_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx ((uint32_t)(sc->sc_dma_sh.cookie.dmac_address +
c533a883a71cff9ff32df1c53c31201e1cbf371fhx offsetof(struct iwk_shared, val0)) >> 4));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, FH_MEM_RCSR_CHNL0_CONFIG_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx FH_RCSR_RX_CONFIG_CHNL_EN_ENABLE_VAL |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx FH_RCSR_CHNL0_RX_CONFIG_IRQ_DEST_INT_HOST_VAL |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_FH_RCSR_RX_CONFIG_REG_VAL_RB_SIZE_4K |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (RX_QUEUE_SIZE_LOG <<
c533a883a71cff9ff32df1c53c31201e1cbf371fhx FH_RCSR_RX_CONFIG_RBDCB_SIZE_BITSHIFT));
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_exit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, FH_RSCSR_CHNL0_RBDCB_WPTR_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (RX_QUEUE_SIZE - 1) & ~0x7);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* init Tx rings */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_enter(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, SCD_TXFACT, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
d62cb7fff63265824a8e6725a3bcef698f6134c9hx /* keep warm page */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, IWK_FH_KW_MEM_ADDR_REG,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dma_kw.cookie.dmac_address >> 4);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (qid = 0; qid < IWK_NUM_QUEUES; qid++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, FH_MEM_CBBC_QUEUE(qid),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_txq[qid].dma_desc.cookie.dmac_address >> 8);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, IWK_FH_TCSR_CHNL_TX_CONFIG_REG(qid),
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_FH_TCSR_TX_CONFIG_REG_VAL_DMA_CHNL_ENABLE |
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_FH_TCSR_TX_CONFIG_REG_VAL_DMA_CREDIT_ENABLE_VAL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_exit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* clear "radio off" and "disable command" bits */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_UCODE_DRV_GP1_CLR,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx CSR_UCODE_DRV_GP1_BIT_CMD_BLOCKED);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* clear any pending interrupts */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_INT, 0xffffffff);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* enable interrupts */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_INT_MASK, CSR_INI_SET_MASK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * backup ucode data part for future use.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx (void) memcpy(sc->sc_dma_fw_data_bak.mem_va,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dma_fw_data.mem_va,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_dma_fw_data.alength);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (n = 0; n < 2; n++) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* load firmware init segment into NIC */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_load_firmware(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err != IWK_SUCCESS) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_init(): "
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "failed to setup boot firmware\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx continue;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* now press "execute" start running */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_RESET, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (n == 2) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_init(): " "failed to load firmware\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* ..and wait at most one second for adapter to initialize */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx clk = ddi_get_lbolt() + drv_usectohz(2000000);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx while (!(sc->sc_flags & IWK_F_FW_INIT)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (cv_timedwait(&sc->sc_fw_cv, &sc->sc_glock, clk) < 0)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx break;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (!(sc->sc_flags & IWK_F_FW_INIT)) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN,
c533a883a71cff9ff32df1c53c31201e1cbf371fhx "iwk_init(): timeout waiting for firmware init\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /*
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * at this point, the firmware is loaded OK, then config the hardware
c533a883a71cff9ff32df1c53c31201e1cbf371fhx * with the ucode API, including rxon, txpower, etc.
c533a883a71cff9ff32df1c53c31201e1cbf371fhx */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = iwk_config(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx if (err) {
c533a883a71cff9ff32df1c53c31201e1cbf371fhx cmn_err(CE_WARN, "iwk_init(): failed to configure device\n");
c533a883a71cff9ff32df1c53c31201e1cbf371fhx goto fail1;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx }
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* at this point, hardware may receive beacons :) */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (IWK_SUCCESS);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxfail1:
c533a883a71cff9ff32df1c53c31201e1cbf371fhx err = IWK_FAIL;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx return (err);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhxstatic void
c533a883a71cff9ff32df1c53c31201e1cbf371fhxiwk_stop(iwk_sc_t *sc)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx{
c533a883a71cff9ff32df1c53c31201e1cbf371fhx uint32_t tmp;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx int i;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_enter(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_RESET, CSR_RESET_REG_FLAG_NEVO_RESET);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* disable interrupts */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_INT_MASK, 0);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_INT, CSR_INI_SET_MASK);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_FH_INT_STATUS, 0xffffffff);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* reset all Tx rings */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx for (i = 0; i < IWK_NUM_QUEUES; i++)
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reset_tx_ring(sc, &sc->sc_txq[i]);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx /* reset Rx ring */
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reset_rx_ring(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_enter(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_reg_write(sc, ALM_APMG_CLK_DIS, APMG_CLK_REG_VAL_DMA_CLK_RQT);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_mac_access_exit(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx DELAY(5);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx iwk_stop_master(sc);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx
c533a883a71cff9ff32df1c53c31201e1cbf371fhx sc->sc_tx_timer = 0;
c533a883a71cff9ff32df1c53c31201e1cbf371fhx tmp = IWK_READ(sc, CSR_RESET);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx IWK_WRITE(sc, CSR_RESET, tmp | CSR_RESET_REG_FLAG_SW_RESET);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx mutex_exit(&sc->sc_glock);
c533a883a71cff9ff32df1c53c31201e1cbf371fhx}
43439c96b8398c01c375889c79bed72d78fb4c39hx
43439c96b8398c01c375889c79bed72d78fb4c39hx/*
43439c96b8398c01c375889c79bed72d78fb4c39hx * Naive implementation of the Adaptive Multi Rate Retry algorithm:
43439c96b8398c01c375889c79bed72d78fb4c39hx * "IEEE 802.11 Rate Adaptation: A Practical Approach"
43439c96b8398c01c375889c79bed72d78fb4c39hx * Mathieu Lacage, Hossein Manshaei, Thierry Turletti
43439c96b8398c01c375889c79bed72d78fb4c39hx * INRIA Sophia - Projet Planete
43439c96b8398c01c375889c79bed72d78fb4c39hx * http://www-sop.inria.fr/rapports/sophia/RR-5208.html
43439c96b8398c01c375889c79bed72d78fb4c39hx */
43439c96b8398c01c375889c79bed72d78fb4c39hx#define is_success(amrr) \
43439c96b8398c01c375889c79bed72d78fb4c39hx ((amrr)->retrycnt < (amrr)->txcnt / 10)
43439c96b8398c01c375889c79bed72d78fb4c39hx#define is_failure(amrr) \
43439c96b8398c01c375889c79bed72d78fb4c39hx ((amrr)->retrycnt > (amrr)->txcnt / 3)
43439c96b8398c01c375889c79bed72d78fb4c39hx#define is_enough(amrr) \
43439c96b8398c01c375889c79bed72d78fb4c39hx ((amrr)->txcnt > 100)
43439c96b8398c01c375889c79bed72d78fb4c39hx#define is_min_rate(in) \
43439c96b8398c01c375889c79bed72d78fb4c39hx ((in)->in_txrate == 0)
43439c96b8398c01c375889c79bed72d78fb4c39hx#define is_max_rate(in) \
43439c96b8398c01c375889c79bed72d78fb4c39hx ((in)->in_txrate == (in)->in_rates.ir_nrates - 1)
43439c96b8398c01c375889c79bed72d78fb4c39hx#define increase_rate(in) \
43439c96b8398c01c375889c79bed72d78fb4c39hx ((in)->in_txrate++)
43439c96b8398c01c375889c79bed72d78fb4c39hx#define decrease_rate(in) \
43439c96b8398c01c375889c79bed72d78fb4c39hx ((in)->in_txrate--)
43439c96b8398c01c375889c79bed72d78fb4c39hx#define reset_cnt(amrr) \
43439c96b8398c01c375889c79bed72d78fb4c39hx { (amrr)->txcnt = (amrr)->retrycnt = 0; }
43439c96b8398c01c375889c79bed72d78fb4c39hx
43439c96b8398c01c375889c79bed72d78fb4c39hx#define IWK_AMRR_MIN_SUCCESS_THRESHOLD 1
43439c96b8398c01c375889c79bed72d78fb4c39hx#define IWK_AMRR_MAX_SUCCESS_THRESHOLD 15
43439c96b8398c01c375889c79bed72d78fb4c39hx
43439c96b8398c01c375889c79bed72d78fb4c39hxstatic void
43439c96b8398c01c375889c79bed72d78fb4c39hxiwk_amrr_init(iwk_amrr_t *amrr)
43439c96b8398c01c375889c79bed72d78fb4c39hx{
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->success = 0;
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->recovery = 0;
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->txcnt = amrr->retrycnt = 0;
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->success_threshold = IWK_AMRR_MIN_SUCCESS_THRESHOLD;
43439c96b8398c01c375889c79bed72d78fb4c39hx}
43439c96b8398c01c375889c79bed72d78fb4c39hx
43439c96b8398c01c375889c79bed72d78fb4c39hxstatic void
43439c96b8398c01c375889c79bed72d78fb4c39hxiwk_amrr_timeout(iwk_sc_t *sc)
43439c96b8398c01c375889c79bed72d78fb4c39hx{
43439c96b8398c01c375889c79bed72d78fb4c39hx ieee80211com_t *ic = &sc->sc_ic;
43439c96b8398c01c375889c79bed72d78fb4c39hx
43439c96b8398c01c375889c79bed72d78fb4c39hx IWK_DBG((IWK_DEBUG_RATECTL, "iwk_amrr_timeout() enter\n"));
43439c96b8398c01c375889c79bed72d78fb4c39hx if (ic->ic_opmode == IEEE80211_M_STA)
43439c96b8398c01c375889c79bed72d78fb4c39hx iwk_amrr_ratectl(NULL, ic->ic_bss);
43439c96b8398c01c375889c79bed72d78fb4c39hx else
43439c96b8398c01c375889c79bed72d78fb4c39hx ieee80211_iterate_nodes(&ic->ic_sta, iwk_amrr_ratectl, NULL);
43439c96b8398c01c375889c79bed72d78fb4c39hx sc->sc_clk = ddi_get_lbolt();
43439c96b8398c01c375889c79bed72d78fb4c39hx}
43439c96b8398c01c375889c79bed72d78fb4c39hx
43439c96b8398c01c375889c79bed72d78fb4c39hx/* ARGSUSED */
43439c96b8398c01c375889c79bed72d78fb4c39hxstatic void
43439c96b8398c01c375889c79bed72d78fb4c39hxiwk_amrr_ratectl(void *arg, ieee80211_node_t *in)
43439c96b8398c01c375889c79bed72d78fb4c39hx{
43439c96b8398c01c375889c79bed72d78fb4c39hx iwk_amrr_t *amrr = (iwk_amrr_t *)in;
43439c96b8398c01c375889c79bed72d78fb4c39hx int need_change = 0;
43439c96b8398c01c375889c79bed72d78fb4c39hx
43439c96b8398c01c375889c79bed72d78fb4c39hx if (is_success(amrr) && is_enough(amrr)) {
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->success++;
43439c96b8398c01c375889c79bed72d78fb4c39hx if (amrr->success >= amrr->success_threshold &&
43439c96b8398c01c375889c79bed72d78fb4c39hx !is_max_rate(in)) {
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->recovery = 1;
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->success = 0;
43439c96b8398c01c375889c79bed72d78fb4c39hx increase_rate(in);
43439c96b8398c01c375889c79bed72d78fb4c39hx IWK_DBG((IWK_DEBUG_RATECTL,
43439c96b8398c01c375889c79bed72d78fb4c39hx "AMRR increasing rate %d (txcnt=%d retrycnt=%d)\n",
43439c96b8398c01c375889c79bed72d78fb4c39hx in->in_txrate, amrr->txcnt, amrr->retrycnt));
43439c96b8398c01c375889c79bed72d78fb4c39hx need_change = 1;
43439c96b8398c01c375889c79bed72d78fb4c39hx } else {
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->recovery = 0;
43439c96b8398c01c375889c79bed72d78fb4c39hx }
43439c96b8398c01c375889c79bed72d78fb4c39hx } else if (is_failure(amrr)) {
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->success = 0;
43439c96b8398c01c375889c79bed72d78fb4c39hx if (!is_min_rate(in)) {
43439c96b8398c01c375889c79bed72d78fb4c39hx if (amrr->recovery) {
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->success_threshold++;
43439c96b8398c01c375889c79bed72d78fb4c39hx if (amrr->success_threshold >
43439c96b8398c01c375889c79bed72d78fb4c39hx IWK_AMRR_MAX_SUCCESS_THRESHOLD)
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->success_threshold =
43439c96b8398c01c375889c79bed72d78fb4c39hx IWK_AMRR_MAX_SUCCESS_THRESHOLD;
43439c96b8398c01c375889c79bed72d78fb4c39hx } else {
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->success_threshold =
43439c96b8398c01c375889c79bed72d78fb4c39hx IWK_AMRR_MIN_SUCCESS_THRESHOLD;
43439c96b8398c01c375889c79bed72d78fb4c39hx }
43439c96b8398c01c375889c79bed72d78fb4c39hx decrease_rate(in);
43439c96b8398c01c375889c79bed72d78fb4c39hx IWK_DBG((IWK_DEBUG_RATECTL,
43439c96b8398c01c375889c79bed72d78fb4c39hx "AMRR decreasing rate %d (txcnt=%d retrycnt=%d)\n",
43439c96b8398c01c375889c79bed72d78fb4c39hx in->in_txrate, amrr->txcnt, amrr->retrycnt));
43439c96b8398c01c375889c79bed72d78fb4c39hx need_change = 1;
43439c96b8398c01c375889c79bed72d78fb4c39hx }
43439c96b8398c01c375889c79bed72d78fb4c39hx amrr->recovery = 0; /* paper is incorrect */
43439c96b8398c01c375889c79bed72d78fb4c39hx }
43439c96b8398c01c375889c79bed72d78fb4c39hx
43439c96b8398c01c375889c79bed72d78fb4c39hx if (is_enough(amrr) || need_change)
43439c96b8398c01c375889c79bed72d78fb4c39hx reset_cnt(amrr);
43439c96b8398c01c375889c79bed72d78fb4c39hx}