mirror of
https://github.com/nxp-imx/mwifiex.git
synced 2024-11-14 02:55:34 +00:00
6228a42a0c
Driver Bug Fixes: ----------------- 1. LF-6972: Updated the License to GPL-2.0 2. Incremented the driver version Signed-off-by: Sherry Sun <sherry.sun@nxp.com>
3668 lines
106 KiB
C
3668 lines
106 KiB
C
/** @file mlan_sdio.c
|
|
*
|
|
* @brief This file contains SDIO specific code
|
|
*
|
|
*
|
|
* Copyright 2008-2021 NXP
|
|
*
|
|
* This software file (the File) is distributed by NXP
|
|
* under the terms of the GNU General Public License Version 2, June 1991
|
|
* (the License). You may use, redistribute and/or modify the File in
|
|
* accordance with the terms and conditions of the License, a copy of which
|
|
* is available by writing to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
|
|
* worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
|
|
*
|
|
* THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE EXPRESSLY DISCLAIMED. The License provides additional details about
|
|
* this warranty disclaimer.
|
|
*
|
|
*/
|
|
|
|
/********************************************************
|
|
Change log:
|
|
10/27/2008: initial version
|
|
********************************************************/
|
|
|
|
#include "mlan.h"
|
|
#ifdef STA_SUPPORT
|
|
#include "mlan_join.h"
|
|
#endif
|
|
#include "mlan_util.h"
|
|
#include "mlan_fw.h"
|
|
#include "mlan_main.h"
|
|
#include "mlan_init.h"
|
|
#include "mlan_wmm.h"
|
|
#include "mlan_11n.h"
|
|
#include "mlan_sdio.h"
|
|
|
|
/********************************************************
|
|
Local Variables
|
|
********************************************************/
|
|
#ifdef SD8887
|
|
static const struct _mlan_sdio_card_reg mlan_reg_sd8887 = {
|
|
.start_rd_port = 0,
|
|
.start_wr_port = 0,
|
|
.base_0_reg = 0x6C,
|
|
.base_1_reg = 0x6D,
|
|
.poll_reg = 0x5C,
|
|
.host_int_enable = UP_LD_HOST_INT_MASK | DN_LD_HOST_INT_MASK |
|
|
CMD_PORT_UPLD_INT_MASK | CMD_PORT_DNLD_INT_MASK,
|
|
.host_int_status = DN_LD_HOST_INT_STATUS | UP_LD_HOST_INT_STATUS |
|
|
DN_LD_CMD_PORT_HOST_INT_STATUS |
|
|
UP_LD_CMD_PORT_HOST_INT_STATUS,
|
|
.status_reg_0 = 0x90,
|
|
.status_reg_1 = 0x91,
|
|
.sdio_int_mask = 0xff,
|
|
.data_port_mask = 0xffffffff,
|
|
.max_mp_regs = 196,
|
|
.rd_bitmap_l = 0x10,
|
|
.rd_bitmap_u = 0x11,
|
|
.rd_bitmap_1l = 0x12,
|
|
.rd_bitmap_1u = 0x13,
|
|
.wr_bitmap_l = 0x14,
|
|
.wr_bitmap_u = 0x15,
|
|
.wr_bitmap_1l = 0x16,
|
|
.wr_bitmap_1u = 0x17,
|
|
.rd_len_p0_l = 0x18,
|
|
.rd_len_p0_u = 0x19,
|
|
.card_config_2_1_reg = 0xD9,
|
|
.cmd_config_0 = 0xC4,
|
|
.cmd_config_1 = 0xC5,
|
|
.cmd_config_2 = 0xC6,
|
|
.cmd_config_3 = 0xC7,
|
|
.cmd_rd_len_0 = 0xC0,
|
|
.cmd_rd_len_1 = 0xC1,
|
|
.cmd_rd_len_2 = 0xC2,
|
|
.cmd_rd_len_3 = 0xC3,
|
|
.io_port_0_reg = 0xE4,
|
|
.io_port_1_reg = 0xE5,
|
|
.io_port_2_reg = 0xE6,
|
|
.host_int_rsr_reg = 0x04,
|
|
.host_int_mask_reg = 0x08,
|
|
.host_int_status_reg = 0x0C,
|
|
.host_restart_reg = 0x58,
|
|
.card_to_host_event_reg = 0x5C,
|
|
.host_interrupt_mask_reg = 0x60,
|
|
.card_interrupt_status_reg = 0x64,
|
|
.card_interrupt_rsr_reg = 0x68,
|
|
.card_revision_reg = 0xC8,
|
|
.card_ocr_0_reg = 0xD4,
|
|
.card_ocr_1_reg = 0xD5,
|
|
.card_ocr_3_reg = 0xD6,
|
|
.card_config_reg = 0xD7,
|
|
.card_misc_cfg_reg = 0xD8,
|
|
.debug_0_reg = 0xDC,
|
|
.debug_1_reg = 0xDD,
|
|
.debug_2_reg = 0xDE,
|
|
.debug_3_reg = 0xDF,
|
|
.fw_reset_reg = 0x0B6,
|
|
.fw_reset_val = 1,
|
|
.winner_check_reg = 0x90,
|
|
};
|
|
|
|
static const struct _mlan_card_info mlan_card_info_sd8887 = {
|
|
.max_tx_buf_size = MLAN_TX_DATA_BUF_SIZE_2K,
|
|
.v16_fw_api = 0,
|
|
.supp_ps_handshake = 0,
|
|
.default_11n_tx_bf_cap = DEFAULT_11N_TX_BF_CAP_1X1,
|
|
};
|
|
#endif
|
|
|
|
#ifdef SD8801
|
|
static const struct _mlan_sdio_card_reg mlan_reg_sd8801 = {
|
|
.start_rd_port = 1,
|
|
.start_wr_port = 1,
|
|
.base_0_reg = 0x40,
|
|
.base_1_reg = 0x41,
|
|
.poll_reg = 0x30,
|
|
.host_int_enable = UP_LD_HOST_INT_MASK | DN_LD_HOST_INT_MASK,
|
|
.host_int_status = DN_LD_HOST_INT_STATUS | UP_LD_HOST_INT_STATUS,
|
|
.status_reg_0 = 0x60,
|
|
.status_reg_1 = 0x61,
|
|
.sdio_int_mask = 0x3f,
|
|
.data_port_mask = 0x0000fffe,
|
|
.max_mp_regs = 64,
|
|
.rd_bitmap_l = 0x4,
|
|
.rd_bitmap_u = 0x5,
|
|
.wr_bitmap_l = 0x6,
|
|
.wr_bitmap_u = 0x7,
|
|
.rd_len_p0_l = 0x8,
|
|
.rd_len_p0_u = 0x9,
|
|
.io_port_0_reg = 0x78,
|
|
.io_port_1_reg = 0x79,
|
|
.io_port_2_reg = 0x7A,
|
|
.host_int_rsr_reg = 0x01,
|
|
.host_int_mask_reg = 0x02,
|
|
.host_int_status_reg = 0x03,
|
|
.card_misc_cfg_reg = 0x6c,
|
|
.fw_reset_reg = 0x64,
|
|
.fw_reset_val = 0,
|
|
};
|
|
|
|
static const struct _mlan_card_info mlan_card_info_sd8801 = {
|
|
.max_tx_buf_size = MLAN_TX_DATA_BUF_SIZE_2K,
|
|
.v14_fw_api = 1,
|
|
.v16_fw_api = 0,
|
|
.supp_ps_handshake = 0,
|
|
.default_11n_tx_bf_cap = DEFAULT_11N_TX_BF_CAP_1X1,
|
|
};
|
|
#endif
|
|
|
|
#ifdef SD8897
|
|
static const struct _mlan_sdio_card_reg mlan_reg_sd8897 = {
|
|
.start_rd_port = 0,
|
|
.start_wr_port = 0,
|
|
.base_0_reg = 0x60,
|
|
.base_1_reg = 0x61,
|
|
.poll_reg = 0x50,
|
|
.host_int_enable = UP_LD_HOST_INT_MASK | DN_LD_HOST_INT_MASK |
|
|
CMD_PORT_UPLD_INT_MASK | CMD_PORT_DNLD_INT_MASK,
|
|
.host_int_status = DN_LD_HOST_INT_STATUS | UP_LD_HOST_INT_STATUS |
|
|
DN_LD_CMD_PORT_HOST_INT_STATUS |
|
|
UP_LD_CMD_PORT_HOST_INT_STATUS,
|
|
.status_reg_0 = 0xC0,
|
|
.status_reg_1 = 0xC1,
|
|
.sdio_int_mask = 0xff,
|
|
.data_port_mask = 0xffffffff,
|
|
.max_mp_regs = 184,
|
|
.rd_bitmap_l = 0x04,
|
|
.rd_bitmap_u = 0x05,
|
|
.rd_bitmap_1l = 0x06,
|
|
.rd_bitmap_1u = 0x07,
|
|
.wr_bitmap_l = 0x08,
|
|
.wr_bitmap_u = 0x09,
|
|
.wr_bitmap_1l = 0x0A,
|
|
.wr_bitmap_1u = 0x0B,
|
|
.rd_len_p0_l = 0x0C,
|
|
.rd_len_p0_u = 0x0D,
|
|
.card_config_2_1_reg = 0xCD,
|
|
.cmd_config_0 = 0xB8,
|
|
.cmd_config_1 = 0xB9,
|
|
.cmd_config_2 = 0xBA,
|
|
.cmd_config_3 = 0xBB,
|
|
.cmd_rd_len_0 = 0xB4,
|
|
.cmd_rd_len_1 = 0xB5,
|
|
.cmd_rd_len_2 = 0xB6,
|
|
.cmd_rd_len_3 = 0xB7,
|
|
.io_port_0_reg = 0xD8,
|
|
.io_port_1_reg = 0xD9,
|
|
.io_port_2_reg = 0xDA,
|
|
.host_int_rsr_reg = 0x01,
|
|
.host_int_mask_reg = 0x02,
|
|
.host_int_status_reg = 0x03,
|
|
.host_restart_reg = 0x4C,
|
|
.card_to_host_event_reg = 0x50,
|
|
.host_interrupt_mask_reg = 0x54,
|
|
.card_interrupt_status_reg = 0x58,
|
|
.card_interrupt_rsr_reg = 0x5C,
|
|
.card_revision_reg = 0xBC,
|
|
.card_ocr_0_reg = 0xC8,
|
|
.card_ocr_1_reg = 0xC9,
|
|
.card_ocr_3_reg = 0xCA,
|
|
.card_config_reg = 0xCB,
|
|
.card_misc_cfg_reg = 0xCC,
|
|
.debug_0_reg = 0xD0,
|
|
.debug_1_reg = 0xD1,
|
|
.debug_2_reg = 0xD2,
|
|
.debug_3_reg = 0xD3,
|
|
.fw_reset_reg = 0x0E8,
|
|
.fw_reset_val = 1,
|
|
.winner_check_reg = 0xC0,
|
|
};
|
|
|
|
static const struct _mlan_card_info mlan_card_info_sd8897 = {
|
|
.max_tx_buf_size = MLAN_TX_DATA_BUF_SIZE_4K,
|
|
.v16_fw_api = 0,
|
|
.supp_ps_handshake = 0,
|
|
.default_11n_tx_bf_cap = DEFAULT_11N_TX_BF_CAP_2X2,
|
|
};
|
|
#endif
|
|
|
|
#if defined(SD8977) || defined(SD8997) || defined(SD8987) || \
|
|
defined(SD9098) || defined(SD9097) || defined(SDNW62X) || \
|
|
defined(SD8978) || defined(SD9177)
|
|
static const struct _mlan_sdio_card_reg mlan_reg_sd8977_sd8997 = {
|
|
.start_rd_port = 0,
|
|
.start_wr_port = 0,
|
|
.base_0_reg = 0xf8,
|
|
.base_1_reg = 0xf9,
|
|
.poll_reg = 0x5C,
|
|
.host_int_enable = UP_LD_HOST_INT_MASK | DN_LD_HOST_INT_MASK |
|
|
CMD_PORT_UPLD_INT_MASK | CMD_PORT_DNLD_INT_MASK,
|
|
.host_int_status = DN_LD_HOST_INT_STATUS | UP_LD_HOST_INT_STATUS |
|
|
DN_LD_CMD_PORT_HOST_INT_STATUS |
|
|
UP_LD_CMD_PORT_HOST_INT_STATUS,
|
|
.status_reg_0 = 0xe8,
|
|
.status_reg_1 = 0xe9,
|
|
.sdio_int_mask = 0xff,
|
|
.data_port_mask = 0xffffffff,
|
|
.max_mp_regs = 196,
|
|
.rd_bitmap_l = 0x10,
|
|
.rd_bitmap_u = 0x11,
|
|
.rd_bitmap_1l = 0x12,
|
|
.rd_bitmap_1u = 0x13,
|
|
.wr_bitmap_l = 0x14,
|
|
.wr_bitmap_u = 0x15,
|
|
.wr_bitmap_1l = 0x16,
|
|
.wr_bitmap_1u = 0x17,
|
|
.rd_len_p0_l = 0x18,
|
|
.rd_len_p0_u = 0x19,
|
|
.card_config_2_1_reg = 0xD9,
|
|
.cmd_config_0 = 0xC4,
|
|
.cmd_config_1 = 0xC5,
|
|
.cmd_config_2 = 0xC6,
|
|
.cmd_config_3 = 0xC7,
|
|
.cmd_rd_len_0 = 0xC0,
|
|
.cmd_rd_len_1 = 0xC1,
|
|
.cmd_rd_len_2 = 0xC2,
|
|
.cmd_rd_len_3 = 0xC3,
|
|
.io_port_0_reg = 0xE4,
|
|
.io_port_1_reg = 0xE5,
|
|
.io_port_2_reg = 0xE6,
|
|
.host_int_rsr_reg = 0x04,
|
|
.host_int_mask_reg = 0x08,
|
|
.host_int_status_reg = 0x0C,
|
|
.host_restart_reg = 0x58,
|
|
.card_to_host_event_reg = 0x5C,
|
|
.host_interrupt_mask_reg = 0x60,
|
|
.card_interrupt_status_reg = 0x64,
|
|
.card_interrupt_rsr_reg = 0x68,
|
|
.card_revision_reg = 0xC8,
|
|
.card_ocr_0_reg = 0xD4,
|
|
.card_ocr_1_reg = 0xD5,
|
|
.card_ocr_3_reg = 0xD6,
|
|
.card_config_reg = 0xD7,
|
|
.card_misc_cfg_reg = 0xD8,
|
|
.debug_0_reg = 0xDC,
|
|
.debug_1_reg = 0xDD,
|
|
.debug_2_reg = 0xDE,
|
|
.debug_3_reg = 0xDF,
|
|
.fw_reset_reg = 0x0EE,
|
|
.fw_reset_val = 0x99,
|
|
.fw_dnld_offset_0_reg = 0xEC,
|
|
.fw_dnld_offset_1_reg = 0xED,
|
|
.fw_dnld_offset_2_reg = 0xEE,
|
|
.fw_dnld_offset_3_reg = 0xEF,
|
|
.fw_dnld_status_0_reg = 0xE8,
|
|
.fw_dnld_status_1_reg = 0xE9,
|
|
.winner_check_reg = 0xFC,
|
|
};
|
|
#endif
|
|
|
|
#ifdef SD8997
|
|
static const struct _mlan_card_info mlan_card_info_sd8997 = {
|
|
.max_tx_buf_size = MLAN_TX_DATA_BUF_SIZE_4K,
|
|
.v16_fw_api = 1,
|
|
.supp_ps_handshake = 0,
|
|
.default_11n_tx_bf_cap = DEFAULT_11N_TX_BF_CAP_2X2,
|
|
};
|
|
#endif
|
|
|
|
#ifdef SD9097
|
|
static const struct _mlan_card_info mlan_card_info_sd9097 = {
|
|
.max_tx_buf_size = MLAN_TX_DATA_BUF_SIZE_4K,
|
|
.v16_fw_api = 1,
|
|
.v17_fw_api = 1,
|
|
.supp_ps_handshake = 0,
|
|
.default_11n_tx_bf_cap = DEFAULT_11N_TX_BF_CAP_2X2,
|
|
};
|
|
#endif
|
|
|
|
#ifdef SDNW62X
|
|
static const struct _mlan_card_info mlan_card_info_sdnw62x = {
|
|
.max_tx_buf_size = MLAN_TX_DATA_BUF_SIZE_4K,
|
|
.v16_fw_api = 1,
|
|
.v17_fw_api = 1,
|
|
.supp_ps_handshake = 0,
|
|
.default_11n_tx_bf_cap = DEFAULT_11N_TX_BF_CAP_2X2,
|
|
};
|
|
#endif
|
|
|
|
#ifdef SD9098
|
|
static const struct _mlan_card_info mlan_card_info_sd9098 = {
|
|
.max_tx_buf_size = MLAN_TX_DATA_BUF_SIZE_4K,
|
|
.v16_fw_api = 1,
|
|
.v17_fw_api = 1,
|
|
.supp_ps_handshake = 0,
|
|
.default_11n_tx_bf_cap = DEFAULT_11N_TX_BF_CAP_2X2,
|
|
};
|
|
#endif
|
|
#ifdef SD9177
|
|
static const struct _mlan_card_info mlan_card_info_sd9177 = {
|
|
.max_tx_buf_size = MLAN_TX_DATA_BUF_SIZE_4K,
|
|
.v16_fw_api = 1,
|
|
.v17_fw_api = 1,
|
|
.supp_ps_handshake = 0,
|
|
.default_11n_tx_bf_cap = DEFAULT_11N_TX_BF_CAP_1X1,
|
|
};
|
|
#endif
|
|
|
|
#if defined(SD8977) || defined(SD8978)
|
|
static const struct _mlan_card_info mlan_card_info_sd8977 = {
|
|
.max_tx_buf_size = MLAN_TX_DATA_BUF_SIZE_2K,
|
|
.v16_fw_api = 1,
|
|
.supp_ps_handshake = 0,
|
|
.default_11n_tx_bf_cap = DEFAULT_11N_TX_BF_CAP_1X1,
|
|
};
|
|
#endif
|
|
|
|
#ifdef SD8987
|
|
static const struct _mlan_card_info mlan_card_info_sd8987 = {
|
|
.max_tx_buf_size = MLAN_TX_DATA_BUF_SIZE_2K,
|
|
.v16_fw_api = 1,
|
|
.supp_ps_handshake = 0,
|
|
.default_11n_tx_bf_cap = DEFAULT_11N_TX_BF_CAP_1X1,
|
|
};
|
|
#endif
|
|
|
|
/********************************************************
|
|
Global Variables
|
|
********************************************************/
|
|
|
|
/********************************************************
|
|
Local Functions
|
|
********************************************************/
|
|
|
|
/**
|
|
* @brief This function initialize the SDIO port
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_init_ioport(mlan_adapter *pmadapter)
|
|
{
|
|
t_u32 reg;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
t_u8 host_int_rsr_reg = pmadapter->pcard_sd->reg->host_int_rsr_reg;
|
|
t_u8 host_int_rsr_mask = pmadapter->pcard_sd->reg->sdio_int_mask;
|
|
t_u8 card_misc_cfg_reg = pmadapter->pcard_sd->reg->card_misc_cfg_reg;
|
|
t_u8 card_config_2_1_reg =
|
|
pmadapter->pcard_sd->reg->card_config_2_1_reg;
|
|
t_u8 cmd_config_0 = pmadapter->pcard_sd->reg->cmd_config_0;
|
|
t_u8 cmd_config_1 = pmadapter->pcard_sd->reg->cmd_config_1;
|
|
|
|
ENTER();
|
|
if (pmadapter->pcard_sd->supports_sdio_new_mode) {
|
|
pmadapter->pcard_sd->ioport = MEM_PORT;
|
|
} else {
|
|
if (MLAN_STATUS_SUCCESS ==
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
pmadapter->pcard_sd->reg->io_port_0_reg,
|
|
®))
|
|
pmadapter->pcard_sd->ioport |= (reg & 0xff);
|
|
else {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
if (MLAN_STATUS_SUCCESS ==
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
pmadapter->pcard_sd->reg->io_port_1_reg,
|
|
®))
|
|
pmadapter->pcard_sd->ioport |= ((reg & 0xff) << 8);
|
|
else {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
if (MLAN_STATUS_SUCCESS ==
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
pmadapter->pcard_sd->reg->io_port_2_reg,
|
|
®))
|
|
pmadapter->pcard_sd->ioport |= ((reg & 0xff) << 16);
|
|
else {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
}
|
|
PRINTM(MINFO, "SDIO FUNC1 IO port: 0x%x\n",
|
|
pmadapter->pcard_sd->ioport);
|
|
|
|
if (pmadapter->pcard_sd->supports_sdio_new_mode) {
|
|
/* enable sdio cmd53 new mode */
|
|
if (MLAN_STATUS_SUCCESS ==
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
card_config_2_1_reg, ®)) {
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
card_config_2_1_reg,
|
|
reg | CMD53_NEW_MODE);
|
|
} else {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
|
|
/* configure cmd port */
|
|
/* enable reading rx length from the register */
|
|
if (MLAN_STATUS_SUCCESS ==
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle, cmd_config_0,
|
|
®)) {
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
cmd_config_0,
|
|
reg | CMD_PORT_RD_LEN_EN);
|
|
} else {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
/* enable Dnld/Upld ready auto reset for cmd port
|
|
* after cmd53 is completed */
|
|
if (MLAN_STATUS_SUCCESS ==
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle, cmd_config_1,
|
|
®)) {
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
cmd_config_1,
|
|
reg | CMD_PORT_AUTO_EN);
|
|
} else {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
}
|
|
|
|
#if defined(SD8977) || defined(SD8978)
|
|
if (IS_SD8977(pmadapter->card_type) ||
|
|
IS_SD8978(pmadapter->card_type)) {
|
|
if ((pmadapter->init_para.int_mode == INT_MODE_GPIO) &&
|
|
(pmadapter->init_para.gpio_pin == GPIO_INT_NEW_MODE)) {
|
|
PRINTM(MMSG, "Enable GPIO-1 int mode\n");
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
SCRATCH_REG_32,
|
|
ENABLE_GPIO_1_INT_MODE);
|
|
}
|
|
}
|
|
#endif
|
|
/* Set Host interrupt reset to read to clear */
|
|
if (MLAN_STATUS_SUCCESS == pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
host_int_rsr_reg, ®)) {
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle, host_int_rsr_reg,
|
|
reg | host_int_rsr_mask);
|
|
} else {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
|
|
/* Dnld/Upld ready set to auto reset */
|
|
if (MLAN_STATUS_SUCCESS == pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
card_misc_cfg_reg,
|
|
®)) {
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle, card_misc_cfg_reg,
|
|
reg | AUTO_RE_ENABLE_INT);
|
|
} else {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief This function sends data to the card.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param pmbuf A pointer to mlan_buffer (pmbuf->data_len should include
|
|
* SDIO header)
|
|
* @param port Port
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_write_data_sync(mlan_adapter *pmadapter,
|
|
mlan_buffer *pmbuf, t_u32 port)
|
|
{
|
|
t_u32 i = 0;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
|
|
ENTER();
|
|
|
|
do {
|
|
ret = pcb->moal_write_data_sync(pmadapter->pmoal_handle, pmbuf,
|
|
port, 0);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
i++;
|
|
PRINTM(MERROR,
|
|
"host_to_card, write iomem (%d) failed: %d\n", i,
|
|
ret);
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
HOST_TO_CARD_EVENT_REG,
|
|
HOST_TERM_CMD53)) {
|
|
PRINTM(MERROR, "write CFG reg failed\n");
|
|
}
|
|
ret = MLAN_STATUS_FAILURE;
|
|
if (i > MAX_WRITE_IOMEM_RETRY) {
|
|
pmbuf->status_code = MLAN_ERROR_DATA_TX_FAIL;
|
|
goto exit;
|
|
}
|
|
}
|
|
} while (ret == MLAN_STATUS_FAILURE);
|
|
exit:
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function gets available SDIO port for reading cmd/data
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param pport A pointer to port number
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_get_rd_port(mlan_adapter *pmadapter, t_u8 *pport)
|
|
{
|
|
t_u32 rd_bitmap = pmadapter->pcard_sd->mp_rd_bitmap;
|
|
const mlan_sdio_card_reg *reg = pmadapter->pcard_sd->reg;
|
|
t_u8 max_ports = pmadapter->pcard_sd->max_ports;
|
|
t_bool new_mode = pmadapter->pcard_sd->supports_sdio_new_mode;
|
|
|
|
ENTER();
|
|
|
|
PRINTM(MIF_D, "wlan_get_rd_port: mp_rd_bitmap=0x%08x\n", rd_bitmap);
|
|
if (new_mode) {
|
|
if (!(rd_bitmap & reg->data_port_mask)) {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
} else {
|
|
if (!(rd_bitmap & (CTRL_PORT_MASK | reg->data_port_mask))) {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
}
|
|
if (!new_mode && (pmadapter->pcard_sd->mp_rd_bitmap & CTRL_PORT_MASK)) {
|
|
pmadapter->pcard_sd->mp_rd_bitmap &= (t_u32)(~CTRL_PORT_MASK);
|
|
*pport = CTRL_PORT;
|
|
PRINTM(MIF_D, "wlan_get_rd_port: port=%d mp_rd_bitmap=0x%08x\n",
|
|
*pport, pmadapter->pcard_sd->mp_rd_bitmap);
|
|
} else {
|
|
if (pmadapter->pcard_sd->mp_rd_bitmap &
|
|
(1 << pmadapter->pcard_sd->curr_rd_port)) {
|
|
pmadapter->pcard_sd->mp_rd_bitmap &= (t_u32)(
|
|
~(1 << pmadapter->pcard_sd->curr_rd_port));
|
|
*pport = pmadapter->pcard_sd->curr_rd_port;
|
|
|
|
/* hw rx wraps round only after port (MAX_PORT-1) */
|
|
if (++pmadapter->pcard_sd->curr_rd_port == max_ports)
|
|
pmadapter->pcard_sd->curr_rd_port =
|
|
reg->start_rd_port;
|
|
} else {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
|
|
PRINTM(MIF_D, "port=%d mp_rd_bitmap=0x%08x -> 0x%08x\n", *pport,
|
|
rd_bitmap, pmadapter->pcard_sd->mp_rd_bitmap);
|
|
}
|
|
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief This function gets available SDIO port for writing data
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param pport A pointer to port number
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_get_wr_port_data(mlan_adapter *pmadapter, t_u8 *pport)
|
|
{
|
|
t_u32 wr_bitmap = pmadapter->pcard_sd->mp_wr_bitmap;
|
|
const mlan_sdio_card_reg *reg = pmadapter->pcard_sd->reg;
|
|
t_bool new_mode = pmadapter->pcard_sd->supports_sdio_new_mode;
|
|
|
|
ENTER();
|
|
|
|
PRINTM(MIF_D, "wlan_get_wr_port_data: mp_wr_bitmap=0x%08x\n",
|
|
wr_bitmap);
|
|
|
|
if (!(wr_bitmap & pmadapter->pcard_sd->mp_data_port_mask)) {
|
|
pmadapter->data_sent = MTRUE;
|
|
LEAVE();
|
|
return MLAN_STATUS_RESOURCE;
|
|
}
|
|
|
|
if (pmadapter->pcard_sd->mp_wr_bitmap &
|
|
(1 << pmadapter->pcard_sd->curr_wr_port)) {
|
|
pmadapter->pcard_sd->mp_wr_bitmap &=
|
|
(t_u32)(~(1 << pmadapter->pcard_sd->curr_wr_port));
|
|
*pport = pmadapter->pcard_sd->curr_wr_port;
|
|
if (++pmadapter->pcard_sd->curr_wr_port ==
|
|
pmadapter->pcard_sd->mp_end_port)
|
|
pmadapter->pcard_sd->curr_wr_port = reg->start_wr_port;
|
|
} else {
|
|
pmadapter->data_sent = MTRUE;
|
|
LEAVE();
|
|
return MLAN_STATUS_RESOURCE;
|
|
}
|
|
if ((!new_mode) && (*pport == CTRL_PORT)) {
|
|
PRINTM(MERROR,
|
|
"Invalid data port=%d cur port=%d mp_wr_bitmap=0x%08x -> 0x%08x\n",
|
|
*pport, pmadapter->pcard_sd->curr_wr_port, wr_bitmap,
|
|
pmadapter->pcard_sd->mp_wr_bitmap);
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
PRINTM(MIF_D, "port=%d mp_wr_bitmap=0x%08x -> 0x%08x\n", *pport,
|
|
wr_bitmap, pmadapter->pcard_sd->mp_wr_bitmap);
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief This function polls the card status register.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param bits the bit mask
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_poll_card_status(mlan_adapter *pmadapter,
|
|
t_u8 bits)
|
|
{
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
t_u32 tries;
|
|
t_u32 cs = 0;
|
|
|
|
ENTER();
|
|
|
|
for (tries = 0; tries < 10000; tries++) {
|
|
if (pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
pmadapter->pcard_sd->reg->poll_reg,
|
|
&cs) != MLAN_STATUS_SUCCESS)
|
|
break;
|
|
else if ((cs & bits) == bits) {
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
wlan_udelay(pmadapter, 10);
|
|
}
|
|
|
|
PRINTM(MERROR,
|
|
"wlan_sdio_poll_card_status failed, tries = %d, cs = 0x%x\n",
|
|
tries, cs);
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
|
|
/**
|
|
* @brief This function reads firmware status registers
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param dat A pointer to keep returned data
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_read_fw_status(mlan_adapter *pmadapter, t_u16 *dat)
|
|
{
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
t_u32 fws0 = 0, fws1 = 0;
|
|
|
|
ENTER();
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
pmadapter->pcard_sd->reg->status_reg_0, &fws0)) {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
pmadapter->pcard_sd->reg->status_reg_1, &fws1)) {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
|
|
*dat = (t_u16)((fws1 << 8) | fws0);
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief This function reads firmware dnld offset registers
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param dat A pointer to keep returned data
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_read_fw_dnld_offset(mlan_adapter *pmadapter,
|
|
t_u32 *dat)
|
|
{
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
const mlan_sdio_card_reg *reg = pmadapter->pcard_sd->reg;
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
t_u32 fw_dnld_offset_0 = 0;
|
|
t_u32 fw_dnld_offset_1 = 0;
|
|
t_u32 fw_dnld_offset_2 = 0;
|
|
t_u32 fw_dnld_offset_3 = 0;
|
|
|
|
ENTER();
|
|
|
|
ret = pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
reg->fw_dnld_offset_0_reg, &fw_dnld_offset_0);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"Dev fw_dnld_offset_0 reg read failed: reg(0x%04X)=0x%x. Terminating download\n",
|
|
reg->fw_dnld_offset_0_reg, fw_dnld_offset_0);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
ret = pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
reg->fw_dnld_offset_1_reg, &fw_dnld_offset_1);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"Dev fw_dnld_offset_1 reg read failed: reg(0x%04X)=0x%x. Terminating download\n",
|
|
reg->fw_dnld_offset_1_reg, fw_dnld_offset_1);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
ret = pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
reg->fw_dnld_offset_2_reg, &fw_dnld_offset_2);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"Dev fw_dnld_offset_2 reg read failed: reg(0x%04X)=0x%x. Terminating download\n",
|
|
reg->fw_dnld_offset_2_reg, fw_dnld_offset_2);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
ret = pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
reg->fw_dnld_offset_3_reg, &fw_dnld_offset_3);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"Dev fw_dnld_offset_3 reg read failed: reg(0x%04X)=0x%x. Terminating download\n",
|
|
reg->fw_dnld_offset_3_reg, fw_dnld_offset_3);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
|
|
*dat = (t_u32)(((fw_dnld_offset_3 & 0xff) << 24) |
|
|
((fw_dnld_offset_2 & 0xff) << 16) |
|
|
((fw_dnld_offset_1 & 0xff) << 8) |
|
|
(fw_dnld_offset_0 & 0xff));
|
|
|
|
done:
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function reads firmware dnld status registers
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param dat A pointer to keep returned data
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_read_fw_dnld_status(mlan_adapter *pmadapter,
|
|
t_u16 *dat)
|
|
{
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
const mlan_sdio_card_reg *reg = pmadapter->pcard_sd->reg;
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
t_u32 fw_dnld_status_0 = 0;
|
|
t_u32 fw_dnld_status_1 = 0;
|
|
|
|
ENTER();
|
|
|
|
ret = pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
reg->fw_dnld_status_0_reg, &fw_dnld_status_0);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"Dev fw_dnld_status_0 reg read failed: reg(0x%04X)=0x%x. Terminating download\n",
|
|
reg->fw_dnld_status_0_reg, fw_dnld_status_0);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
ret = pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
reg->fw_dnld_status_1_reg, &fw_dnld_status_1);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"Dev fw_dnld_status_1 reg read failed: reg(0x%04X)=0x%x. Terminating download\n",
|
|
reg->fw_dnld_status_1_reg, fw_dnld_status_1);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
|
|
*dat = (t_u16)(((fw_dnld_status_1 & 0xff) << 8) |
|
|
(fw_dnld_status_0 & 0xff));
|
|
|
|
done:
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/** @brief This function disables the host interrupts mask.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param mask the interrupt mask
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_disable_host_int_mask(pmlan_adapter pmadapter,
|
|
t_u8 mask)
|
|
{
|
|
t_u32 host_int_mask = 0;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
|
|
ENTER();
|
|
|
|
/* Read back the host_int_mask register */
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
pmadapter->pcard_sd->reg->host_int_mask_reg,
|
|
&host_int_mask)) {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
|
|
/* Update with the mask and write back to the register */
|
|
host_int_mask &= ~mask;
|
|
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
pmadapter->pcard_sd->reg->host_int_mask_reg,
|
|
host_int_mask)) {
|
|
PRINTM(MWARN, "Disable host interrupt failed\n");
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief This function enables the host interrupts mask
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param mask the interrupt mask
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_enable_host_int_mask(pmlan_adapter pmadapter,
|
|
t_u8 mask)
|
|
{
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
|
|
ENTER();
|
|
|
|
/* Simply write the mask to the register */
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
pmadapter->pcard_sd->reg->host_int_mask_reg,
|
|
mask)) {
|
|
PRINTM(MWARN, "Enable host interrupt failed\n");
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief This function reads data from the card.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param type A pointer to keep type as data or command
|
|
* @param nb A pointer to keep the data/cmd length returned in buffer
|
|
* @param pmbuf A pointer to the SDIO data/cmd buffer
|
|
* @param npayload the length of data/cmd buffer
|
|
* @param ioport the SDIO ioport
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_card_to_host(mlan_adapter *pmadapter, t_u32 *type,
|
|
t_u32 *nb, pmlan_buffer pmbuf,
|
|
t_u32 npayload, t_u32 ioport)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
t_u32 i = 0;
|
|
|
|
ENTER();
|
|
|
|
if (!pmbuf) {
|
|
PRINTM(MWARN, "pmbuf is NULL!\n");
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto exit;
|
|
}
|
|
do {
|
|
ret = pcb->moal_read_data_sync(pmadapter->pmoal_handle, pmbuf,
|
|
ioport, 0);
|
|
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"wlan: cmd53 read failed: %d ioport=0x%x retry=%d\n",
|
|
ret, ioport, i);
|
|
i++;
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
HOST_TO_CARD_EVENT_REG,
|
|
HOST_TERM_CMD53)) {
|
|
PRINTM(MERROR, "Set Term cmd53 failed\n");
|
|
}
|
|
if (i > MAX_WRITE_IOMEM_RETRY) {
|
|
pmbuf->status_code = MLAN_ERROR_DATA_RX_FAIL;
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto exit;
|
|
}
|
|
}
|
|
} while (ret == MLAN_STATUS_FAILURE);
|
|
*nb = wlan_le16_to_cpu(*(t_u16 *)(pmbuf->pbuf + pmbuf->data_offset));
|
|
if (*nb > npayload) {
|
|
PRINTM(MERROR, "invalid packet, *nb=%d, npayload=%d\n", *nb,
|
|
npayload);
|
|
pmbuf->status_code = MLAN_ERROR_PKT_SIZE_INVALID;
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto exit;
|
|
}
|
|
|
|
DBG_HEXDUMP(MIF_D, "SDIO Blk Rd", pmbuf->pbuf + pmbuf->data_offset,
|
|
MIN(*nb, MAX_DATA_DUMP_LEN));
|
|
|
|
*type = wlan_le16_to_cpu(
|
|
*(t_u16 *)(pmbuf->pbuf + pmbuf->data_offset + 2));
|
|
|
|
exit:
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function downloads FW blocks to device
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter
|
|
* @param firmware A pointer to firmware image
|
|
* @param firmwarelen firmware len
|
|
*
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_prog_fw_w_helper(pmlan_adapter pmadapter, t_u8 *fw,
|
|
t_u32 fw_len)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
t_u8 *firmware = fw;
|
|
t_u32 firmwarelen = fw_len;
|
|
t_u32 offset = 0;
|
|
t_u32 base0, base1;
|
|
t_void *tmpfwbuf = MNULL;
|
|
t_u32 tmpfwbufsz;
|
|
t_u8 *fwbuf;
|
|
mlan_buffer mbuf;
|
|
t_u16 len = 0;
|
|
t_u32 txlen = 0, tx_blocks = 0, tries = 0;
|
|
t_u32 i = 0;
|
|
const mlan_sdio_card_reg *reg = pmadapter->pcard_sd->reg;
|
|
t_u32 read_base_0_reg = reg->base_0_reg;
|
|
t_u32 read_base_1_reg = reg->base_1_reg;
|
|
#if defined(SD9098)
|
|
t_u32 rev_id_reg = 0;
|
|
t_u32 revision_id = 0;
|
|
#endif
|
|
t_u8 check_fw_status = MFALSE;
|
|
t_u16 fw_dnld_status = 0;
|
|
t_u32 fw_dnld_offset = 0;
|
|
t_u8 mic_retry = 0;
|
|
|
|
ENTER();
|
|
|
|
if (!firmware && !pcb->moal_get_fw_data) {
|
|
PRINTM(MMSG, "No firmware image found! Terminating download\n");
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
|
|
PRINTM(MINFO, "WLAN: Downloading FW image (%d bytes)\n", firmwarelen);
|
|
|
|
tmpfwbufsz = ALIGN_SZ(WLAN_UPLD_SIZE, DMA_ALIGNMENT);
|
|
ret = pcb->moal_malloc(pmadapter->pmoal_handle, tmpfwbufsz,
|
|
MLAN_MEM_DEF | MLAN_MEM_DMA, (t_u8 **)&tmpfwbuf);
|
|
if ((ret != MLAN_STATUS_SUCCESS) || !tmpfwbuf) {
|
|
PRINTM(MERROR,
|
|
"Unable to allocate buffer for firmware. Terminating download\n");
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
memset(pmadapter, tmpfwbuf, 0, tmpfwbufsz);
|
|
/* Ensure 8-byte aligned firmware buffer */
|
|
fwbuf = (t_u8 *)ALIGN_ADDR(tmpfwbuf, DMA_ALIGNMENT);
|
|
#if defined(SD9098)
|
|
if (IS_SD9098(pmadapter->card_type)) {
|
|
rev_id_reg = pmadapter->pcard_sd->reg->card_revision_reg;
|
|
ret = pcb->moal_read_reg(pmadapter->pmoal_handle, rev_id_reg,
|
|
&revision_id);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"Card Revision register read failed:"
|
|
"card_revision_reg=0x%x\n",
|
|
rev_id_reg);
|
|
goto done;
|
|
}
|
|
/* Skyhawk A0, need to check both CRC and MIC error */
|
|
if (revision_id >= CHIP_9098_REV_A0)
|
|
check_fw_status = MTRUE;
|
|
}
|
|
#endif
|
|
#if defined(SD9097) || defined(SD9177) || defined(SDNW62X)
|
|
if (IS_SD9097(pmadapter->card_type) ||
|
|
IS_SDNW62X(pmadapter->card_type) || IS_SD9177(pmadapter->card_type))
|
|
check_fw_status = MTRUE;
|
|
#endif
|
|
|
|
/* Perform firmware data transfer */
|
|
do {
|
|
/* The host polls for the DN_LD_CARD_RDY and CARD_IO_READY bits
|
|
*/
|
|
ret = wlan_sdio_poll_card_status(
|
|
pmadapter, CARD_IO_READY | DN_LD_CARD_RDY);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MFATAL,
|
|
"WLAN: FW download with helper poll status timeout @ %d\n",
|
|
offset);
|
|
goto done;
|
|
}
|
|
|
|
/* More data */
|
|
if (firmwarelen && offset >= firmwarelen)
|
|
break;
|
|
|
|
for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
|
|
ret = pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
read_base_0_reg, &base0);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"Dev BASE0 register read failed:"
|
|
" base0=0x%04X(%d). Terminating download\n",
|
|
base0, base0);
|
|
goto done;
|
|
}
|
|
ret = pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
read_base_1_reg, &base1);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"Dev BASE1 register read failed:"
|
|
" base1=0x%04X(%d). Terminating download\n",
|
|
base1, base1);
|
|
goto done;
|
|
}
|
|
len = (t_u16)(((base1 & 0xff) << 8) | (base0 & 0xff));
|
|
|
|
if (len)
|
|
break;
|
|
wlan_udelay(pmadapter, 10);
|
|
}
|
|
|
|
if (!len)
|
|
break;
|
|
else if (len > WLAN_UPLD_SIZE) {
|
|
PRINTM(MFATAL,
|
|
"WLAN: FW download failure @ %d, invalid length %d\n",
|
|
offset, len);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
|
|
/* Ignore CRC check before download the 1st packet */
|
|
if (offset == 0 && (len & MBIT(0)))
|
|
len &= ~MBIT(0);
|
|
|
|
txlen = len;
|
|
|
|
if (len & MBIT(0)) {
|
|
/* New fw download process, check CRC and MIC error */
|
|
if (check_fw_status) {
|
|
/* Get offset from fw dnld offset Register */
|
|
ret = wlan_sdio_read_fw_dnld_offset(
|
|
pmadapter, &fw_dnld_offset);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MFATAL,
|
|
"WLAN: FW download with helper read fw dnld offset failed @ %d\n",
|
|
offset);
|
|
goto done;
|
|
}
|
|
/* Get CRC MIC error from fw dnld status
|
|
* Register */
|
|
ret = wlan_sdio_read_fw_dnld_status(
|
|
pmadapter, &fw_dnld_status);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MFATAL,
|
|
"WLAN: FW download with helper read fw dnld status failed @ %d\n",
|
|
offset);
|
|
goto done;
|
|
}
|
|
PRINTM(MERROR,
|
|
"WLAN: FW download error: status=0x%x offset = 0x%x fw offset = 0x%x\n",
|
|
fw_dnld_status, offset, fw_dnld_offset);
|
|
}
|
|
i++;
|
|
if (i > MAX_WRITE_IOMEM_RETRY) {
|
|
PRINTM(MFATAL,
|
|
"WLAN: FW download failure @ %d, over max retry count\n",
|
|
offset);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
|
|
PRINTM(MERROR,
|
|
"WLAN: FW CRC error indicated by the helper:"
|
|
" len = 0x%04X, txlen = %d\n",
|
|
len, txlen);
|
|
len &= ~MBIT(0);
|
|
if (fw_dnld_status & (MBIT(6) | MBIT(7))) {
|
|
offset = 0;
|
|
mic_retry++;
|
|
if (mic_retry > MAX_FW_RETRY) {
|
|
PRINTM(MFATAL,
|
|
"WLAN: FW download failure @ %d, over max mic retry count\n",
|
|
offset);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
}
|
|
PRINTM(MERROR, "WLAN: retry: %d, offset %d\n", i,
|
|
offset);
|
|
DBG_HEXDUMP(MERROR, "WLAN: FW block:", fwbuf, len);
|
|
/* Setting this to 0 to resend from same offset */
|
|
txlen = 0;
|
|
} else {
|
|
i = 0;
|
|
|
|
/* Set blocksize to transfer - checking
|
|
* for last block */
|
|
if (firmwarelen && firmwarelen - offset < txlen)
|
|
txlen = firmwarelen - offset;
|
|
PRINTM(MINFO, ".");
|
|
|
|
tx_blocks = (txlen + MLAN_SDIO_BLOCK_SIZE_FW_DNLD - 1) /
|
|
MLAN_SDIO_BLOCK_SIZE_FW_DNLD;
|
|
|
|
/* Copy payload to buffer */
|
|
if (firmware)
|
|
memmove(pmadapter, fwbuf, &firmware[offset],
|
|
txlen);
|
|
else
|
|
pcb->moal_get_fw_data(pmadapter->pmoal_handle,
|
|
offset, txlen, fwbuf);
|
|
}
|
|
|
|
/* Send data */
|
|
memset(pmadapter, &mbuf, 0, sizeof(mlan_buffer));
|
|
mbuf.pbuf = (t_u8 *)fwbuf;
|
|
mbuf.data_len = tx_blocks * MLAN_SDIO_BLOCK_SIZE_FW_DNLD;
|
|
|
|
ret = pcb->moal_write_data_sync(pmadapter->pmoal_handle, &mbuf,
|
|
pmadapter->pcard_sd->ioport, 0);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"WLAN: FW download, write iomem (%d) failed @ %d\n",
|
|
i, offset);
|
|
if (pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
HOST_TO_CARD_EVENT_REG,
|
|
HOST_TERM_CMD53) !=
|
|
MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR, "write CFG reg failed\n");
|
|
}
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
|
|
offset += txlen;
|
|
} while (MTRUE);
|
|
|
|
PRINTM(MMSG, "Wlan: FW download over, firmwarelen=%d downloaded %d\n",
|
|
firmwarelen, offset);
|
|
|
|
ret = MLAN_STATUS_SUCCESS;
|
|
done:
|
|
if (tmpfwbuf)
|
|
pcb->moal_mfree(pmadapter->pmoal_handle, (t_u8 *)tmpfwbuf);
|
|
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function disables the host interrupts.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_disable_sdio_host_int(pmlan_adapter pmadapter)
|
|
{
|
|
mlan_status ret;
|
|
|
|
ENTER();
|
|
ret = wlan_sdio_disable_host_int_mask(pmadapter, HIM_DISABLE);
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function decodes the rx packet &
|
|
* calls corresponding handlers according to the packet type
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param pmbuf A pointer to the SDIO data/cmd buffer
|
|
* @param upld_typ Type of rx packet
|
|
* @param lock_flag flag for spin_lock.
|
|
* @return MLAN_STATUS_SUCCESS
|
|
*/
|
|
static mlan_status wlan_decode_rx_packet(mlan_adapter *pmadapter,
|
|
mlan_buffer *pmbuf, t_u32 upld_typ,
|
|
t_u8 lock_flag)
|
|
{
|
|
t_u8 *cmd_buf;
|
|
t_u32 event;
|
|
t_u32 in_ts_sec, in_ts_usec;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
|
|
ENTER();
|
|
|
|
switch (upld_typ) {
|
|
case MLAN_TYPE_SPA_DATA:
|
|
PRINTM(MINFO, "--- Rx: SPA Data packet ---\n");
|
|
pmbuf->data_len = pmadapter->upld_len;
|
|
if (pmadapter->rx_work_flag) {
|
|
pmbuf->buf_type = MLAN_BUF_TYPE_SPA_DATA;
|
|
if (lock_flag)
|
|
pmadapter->callbacks.moal_spin_lock(
|
|
pmadapter->pmoal_handle,
|
|
pmadapter->rx_data_queue.plock);
|
|
util_enqueue_list_tail(pmadapter->pmoal_handle,
|
|
&pmadapter->rx_data_queue,
|
|
(pmlan_linked_list)pmbuf, MNULL,
|
|
MNULL);
|
|
pmadapter->rx_pkts_queued++;
|
|
if (lock_flag)
|
|
pmadapter->callbacks.moal_spin_unlock(
|
|
pmadapter->pmoal_handle,
|
|
pmadapter->rx_data_queue.plock);
|
|
} else {
|
|
wlan_decode_spa_buffer(pmadapter,
|
|
pmbuf->pbuf + pmbuf->data_offset,
|
|
pmbuf->data_len);
|
|
wlan_free_mlan_buffer(pmadapter, pmbuf);
|
|
}
|
|
pmadapter->data_received = MTRUE;
|
|
break;
|
|
case MLAN_TYPE_DATA:
|
|
PRINTM(MINFO, "--- Rx: Data packet ---\n");
|
|
if (pmadapter->upld_len > pmbuf->data_len) {
|
|
PRINTM(MERROR,
|
|
"SDIO: Drop packet upld_len=%d data_len=%d \n",
|
|
pmadapter->upld_len, pmbuf->data_len);
|
|
wlan_free_mlan_buffer(pmadapter, pmbuf);
|
|
break;
|
|
}
|
|
pmbuf->data_len = (pmadapter->upld_len - SDIO_INTF_HEADER_LEN);
|
|
pmbuf->data_offset += SDIO_INTF_HEADER_LEN;
|
|
if (pmadapter->rx_work_flag) {
|
|
// rx_trace 5
|
|
if (pmadapter->tp_state_on) {
|
|
pmadapter->callbacks.moal_tp_accounting(
|
|
pmadapter->pmoal_handle, pmbuf,
|
|
5 /*RX_DROP_P1*/);
|
|
pcb->moal_get_system_time(
|
|
pmadapter->pmoal_handle, &in_ts_sec,
|
|
&in_ts_usec);
|
|
pmbuf->in_ts_sec = in_ts_sec;
|
|
pmbuf->in_ts_usec = in_ts_usec;
|
|
}
|
|
if (pmadapter->tp_state_drop_point ==
|
|
5 /*RX_DROP_P1*/) {
|
|
pmadapter->ops.data_complete(
|
|
pmadapter, pmbuf, MLAN_STATUS_SUCCESS);
|
|
} else {
|
|
if (lock_flag)
|
|
pmadapter->callbacks.moal_spin_lock(
|
|
pmadapter->pmoal_handle,
|
|
pmadapter->rx_data_queue.plock);
|
|
util_enqueue_list_tail(
|
|
pmadapter->pmoal_handle,
|
|
&pmadapter->rx_data_queue,
|
|
(pmlan_linked_list)pmbuf, MNULL, MNULL);
|
|
pmadapter->rx_pkts_queued++;
|
|
if (pmadapter->tp_state_on)
|
|
pmadapter->callbacks
|
|
.moal_tp_accounting_rx_param(
|
|
pmadapter->pmoal_handle,
|
|
1,
|
|
pmadapter
|
|
->rx_pkts_queued);
|
|
if (lock_flag)
|
|
pmadapter->callbacks.moal_spin_unlock(
|
|
pmadapter->pmoal_handle,
|
|
pmadapter->rx_data_queue.plock);
|
|
}
|
|
} else {
|
|
wlan_handle_rx_packet(pmadapter, pmbuf);
|
|
}
|
|
pmadapter->data_received = MTRUE;
|
|
break;
|
|
|
|
case MLAN_TYPE_CMD:
|
|
PRINTM(MINFO, "--- Rx: Cmd Response ---\n");
|
|
/* take care of curr_cmd = NULL case */
|
|
if (!pmadapter->curr_cmd) {
|
|
cmd_buf = pmadapter->upld_buf;
|
|
if (pmadapter->ps_state == PS_STATE_SLEEP_CFM) {
|
|
wlan_process_sleep_confirm_resp(
|
|
pmadapter,
|
|
pmbuf->pbuf + pmbuf->data_offset +
|
|
SDIO_INTF_HEADER_LEN,
|
|
pmadapter->upld_len -
|
|
SDIO_INTF_HEADER_LEN);
|
|
}
|
|
pmadapter->upld_len -= SDIO_INTF_HEADER_LEN;
|
|
memcpy_ext(pmadapter, cmd_buf,
|
|
pmbuf->pbuf + pmbuf->data_offset +
|
|
SDIO_INTF_HEADER_LEN,
|
|
pmadapter->upld_len - SDIO_INTF_HEADER_LEN,
|
|
MRVDRV_SIZE_OF_CMD_BUFFER);
|
|
wlan_free_mlan_buffer(pmadapter, pmbuf);
|
|
} else {
|
|
pmadapter->cmd_resp_received = MTRUE;
|
|
pmadapter->upld_len -= SDIO_INTF_HEADER_LEN;
|
|
pmbuf->data_len = pmadapter->upld_len;
|
|
pmbuf->data_offset += SDIO_INTF_HEADER_LEN;
|
|
pmadapter->curr_cmd->respbuf = pmbuf;
|
|
if (pmadapter->upld_len >= MRVDRV_SIZE_OF_CMD_BUFFER) {
|
|
PRINTM(MMSG, "Invalid CmdResp len=%d\n",
|
|
pmadapter->upld_len);
|
|
DBG_HEXDUMP(MERROR, "Invalid CmdResp",
|
|
pmbuf->pbuf + pmbuf->data_offset,
|
|
MAX_DATA_DUMP_LEN);
|
|
}
|
|
}
|
|
break;
|
|
|
|
case MLAN_TYPE_EVENT:
|
|
PRINTM(MINFO, "--- Rx: Event ---\n");
|
|
event = *(t_u32 *)&pmbuf->pbuf[pmbuf->data_offset +
|
|
SDIO_INTF_HEADER_LEN];
|
|
pmadapter->event_cause = wlan_le32_to_cpu(event);
|
|
if ((pmadapter->upld_len > MLAN_EVENT_HEADER_LEN) &&
|
|
((pmadapter->upld_len - MLAN_EVENT_HEADER_LEN) <
|
|
MAX_EVENT_SIZE)) {
|
|
memcpy_ext(pmadapter, pmadapter->event_body,
|
|
pmbuf->pbuf + pmbuf->data_offset +
|
|
MLAN_EVENT_HEADER_LEN,
|
|
pmadapter->upld_len - MLAN_EVENT_HEADER_LEN,
|
|
MAX_EVENT_SIZE);
|
|
}
|
|
|
|
/* event cause has been saved to adapter->event_cause */
|
|
pmadapter->event_received = MTRUE;
|
|
pmbuf->data_len = pmadapter->upld_len;
|
|
pmadapter->pmlan_buffer_event = pmbuf;
|
|
|
|
/* remove SDIO header */
|
|
pmbuf->data_offset += SDIO_INTF_HEADER_LEN;
|
|
pmbuf->data_len -= SDIO_INTF_HEADER_LEN;
|
|
break;
|
|
|
|
default:
|
|
PRINTM(MERROR, "SDIO unknown upload type = 0x%x\n", upld_typ);
|
|
wlan_free_mlan_buffer(pmadapter, pmbuf);
|
|
break;
|
|
}
|
|
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief This function receives single packet
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_receive_single_packet(mlan_adapter *pmadapter)
|
|
{
|
|
mlan_buffer *pmbuf;
|
|
t_u8 port;
|
|
t_u16 rx_len;
|
|
t_u32 pkt_type = 0;
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
|
|
ENTER();
|
|
pmbuf = pmadapter->pcard_sd->mpa_rx.mbuf_arr[0];
|
|
port = pmadapter->pcard_sd->mpa_rx.start_port;
|
|
rx_len = pmadapter->pcard_sd->mpa_rx.len_arr[0];
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
wlan_sdio_card_to_host(pmadapter, &pkt_type,
|
|
(t_u32 *)&pmadapter->upld_len, pmbuf, rx_len,
|
|
pmadapter->pcard_sd->ioport + port)) {
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
if (pkt_type != MLAN_TYPE_DATA && pkt_type != MLAN_TYPE_SPA_DATA) {
|
|
PRINTM(MERROR,
|
|
"receive a wrong pkt from DATA PORT: type=%d, len=%dd\n",
|
|
pkt_type, pmbuf->data_len);
|
|
pmbuf->status_code = MLAN_ERROR_DATA_RX_FAIL;
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
pmadapter->pcard_sd->mpa_rx_count[0]++;
|
|
wlan_decode_rx_packet(pmadapter, pmbuf, pkt_type, MTRUE);
|
|
done:
|
|
if (ret != MLAN_STATUS_SUCCESS)
|
|
wlan_free_mlan_buffer(pmadapter, pmbuf);
|
|
MP_RX_AGGR_BUF_RESET(pmadapter);
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function receives data from the card in aggregate mode.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_receive_mp_aggr_buf(mlan_adapter *pmadapter)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
mlan_buffer mbuf_aggr;
|
|
mlan_buffer *mbuf_deaggr;
|
|
t_u32 pind = 0;
|
|
t_u32 pkt_len, pkt_type = 0;
|
|
t_u8 *curr_ptr;
|
|
t_u32 cmd53_port = 0;
|
|
t_u32 i = 0;
|
|
t_u32 port_count = 0;
|
|
t_bool new_mode = pmadapter->pcard_sd->supports_sdio_new_mode;
|
|
|
|
/* do aggr RX now */
|
|
PRINTM(MINFO, "do_rx_aggr: num of packets: %d\n",
|
|
pmadapter->pcard_sd->mpa_rx.pkt_cnt);
|
|
|
|
memset(pmadapter, &mbuf_aggr, 0, sizeof(mlan_buffer));
|
|
|
|
if (pmadapter->pcard_sd->mpa_rx.pkt_cnt == 1)
|
|
return wlan_receive_single_packet(pmadapter);
|
|
if (!pmadapter->pcard_sd->mpa_rx.buf) {
|
|
mbuf_aggr.data_len = pmadapter->pcard_sd->mpa_rx.buf_len;
|
|
mbuf_aggr.pnext = mbuf_aggr.pprev = &mbuf_aggr;
|
|
mbuf_aggr.use_count = 0;
|
|
for (pind = 0; pind < pmadapter->pcard_sd->mpa_rx.pkt_cnt;
|
|
pind++) {
|
|
pmadapter->pcard_sd->mpa_rx.mbuf_arr[pind]->data_len =
|
|
pmadapter->pcard_sd->mpa_rx.len_arr[pind];
|
|
wlan_link_buf_to_aggr(
|
|
&mbuf_aggr,
|
|
pmadapter->pcard_sd->mpa_rx.mbuf_arr[pind]);
|
|
}
|
|
} else {
|
|
mbuf_aggr.pbuf = (t_u8 *)pmadapter->pcard_sd->mpa_rx.buf;
|
|
mbuf_aggr.data_len = pmadapter->pcard_sd->mpa_rx.buf_len;
|
|
}
|
|
|
|
if (new_mode) {
|
|
port_count = bitcount(pmadapter->pcard_sd->mpa_rx.ports) - 1;
|
|
/* port_count = pmadapter->mpa_rx.pkt_cnt - 1; */
|
|
cmd53_port = (pmadapter->pcard_sd->ioport | SDIO_MPA_ADDR_BASE |
|
|
(port_count << 8)) +
|
|
pmadapter->pcard_sd->mpa_rx.start_port;
|
|
} else {
|
|
cmd53_port = (pmadapter->pcard_sd->ioport | SDIO_MPA_ADDR_BASE |
|
|
(pmadapter->pcard_sd->mpa_rx.ports << 4)) +
|
|
pmadapter->pcard_sd->mpa_rx.start_port;
|
|
}
|
|
do {
|
|
ret = pcb->moal_read_data_sync(pmadapter->pmoal_handle,
|
|
&mbuf_aggr, cmd53_port, 0);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"wlan: sdio mp cmd53 read failed: %d ioport=0x%x retry=%d\n",
|
|
ret, cmd53_port, i);
|
|
i++;
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
HOST_TO_CARD_EVENT_REG,
|
|
HOST_TERM_CMD53)) {
|
|
PRINTM(MERROR, "Set Term cmd53 failed\n");
|
|
}
|
|
if (i > MAX_WRITE_IOMEM_RETRY) {
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
}
|
|
} while (ret == MLAN_STATUS_FAILURE);
|
|
if (pmadapter->rx_work_flag)
|
|
pmadapter->callbacks.moal_spin_lock(
|
|
pmadapter->pmoal_handle,
|
|
pmadapter->rx_data_queue.plock);
|
|
if (!pmadapter->pcard_sd->mpa_rx.buf &&
|
|
pmadapter->pcard_sd->mpa_rx.pkt_cnt > 1) {
|
|
for (pind = 0; pind < pmadapter->pcard_sd->mpa_rx.pkt_cnt;
|
|
pind++) {
|
|
mbuf_deaggr =
|
|
pmadapter->pcard_sd->mpa_rx.mbuf_arr[pind];
|
|
pkt_len = wlan_le16_to_cpu(
|
|
*(t_u16 *)(mbuf_deaggr->pbuf +
|
|
mbuf_deaggr->data_offset));
|
|
pkt_type = wlan_le16_to_cpu(
|
|
*(t_u16 *)(mbuf_deaggr->pbuf +
|
|
mbuf_deaggr->data_offset + 2));
|
|
pmadapter->upld_len = pkt_len;
|
|
wlan_decode_rx_packet(pmadapter, mbuf_deaggr, pkt_type,
|
|
MFALSE);
|
|
}
|
|
} else {
|
|
DBG_HEXDUMP(MIF_D, "SDIO MP-A Blk Rd",
|
|
pmadapter->pcard_sd->mpa_rx.buf,
|
|
MIN(pmadapter->pcard_sd->mpa_rx.buf_len,
|
|
MAX_DATA_DUMP_LEN));
|
|
|
|
curr_ptr = pmadapter->pcard_sd->mpa_rx.buf;
|
|
|
|
for (pind = 0; pind < pmadapter->pcard_sd->mpa_rx.pkt_cnt;
|
|
pind++) {
|
|
/* get curr PKT len & type */
|
|
pkt_len = wlan_le16_to_cpu(*(t_u16 *)&curr_ptr[0]);
|
|
pkt_type = wlan_le16_to_cpu(*(t_u16 *)&curr_ptr[2]);
|
|
|
|
PRINTM(MINFO, "RX: [%d] pktlen: %d pkt_type: 0x%x\n",
|
|
pind, pkt_len, pkt_type);
|
|
|
|
/* copy pkt to deaggr buf */
|
|
mbuf_deaggr =
|
|
pmadapter->pcard_sd->mpa_rx.mbuf_arr[pind];
|
|
if ((pkt_type == MLAN_TYPE_DATA ||
|
|
pkt_type == MLAN_TYPE_SPA_DATA) &&
|
|
(pkt_len <=
|
|
pmadapter->pcard_sd->mpa_rx.len_arr[pind])) {
|
|
memcpy_ext(pmadapter,
|
|
mbuf_deaggr->pbuf +
|
|
mbuf_deaggr->data_offset,
|
|
curr_ptr, pkt_len, pkt_len);
|
|
pmadapter->upld_len = pkt_len;
|
|
/* Process de-aggr packet */
|
|
wlan_decode_rx_packet(pmadapter, mbuf_deaggr,
|
|
pkt_type, MFALSE);
|
|
} else {
|
|
PRINTM(MERROR,
|
|
"Wrong aggr packet: type=%d, len=%d, max_len=%d\n",
|
|
pkt_type, pkt_len,
|
|
pmadapter->pcard_sd->mpa_rx
|
|
.len_arr[pind]);
|
|
wlan_free_mlan_buffer(pmadapter, mbuf_deaggr);
|
|
}
|
|
curr_ptr += pmadapter->pcard_sd->mpa_rx.len_arr[pind];
|
|
}
|
|
}
|
|
if (pmadapter->rx_work_flag)
|
|
pmadapter->callbacks.moal_spin_unlock(
|
|
pmadapter->pmoal_handle,
|
|
pmadapter->rx_data_queue.plock);
|
|
pmadapter->pcard_sd
|
|
->mpa_rx_count[pmadapter->pcard_sd->mpa_rx.pkt_cnt - 1]++;
|
|
MP_RX_AGGR_BUF_RESET(pmadapter);
|
|
done:
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function receives data from the card in aggregate mode.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param pmbuf A pointer to the SDIO data/cmd buffer
|
|
* @param port Current port on which packet needs to be rxed
|
|
* @param rx_len Length of received packet
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_card_to_host_mp_aggr(mlan_adapter *pmadapter,
|
|
mlan_buffer *pmbuf, t_u8 port,
|
|
t_u16 rx_len)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
t_s32 f_do_rx_aggr = 0;
|
|
t_s32 f_do_rx_cur = 0;
|
|
t_s32 f_aggr_cur = 0;
|
|
t_s32 f_post_aggr_cur = 0;
|
|
t_u32 pind = 0;
|
|
t_u32 pkt_type = 0;
|
|
const mlan_sdio_card_reg *reg = pmadapter->pcard_sd->reg;
|
|
t_bool new_mode = pmadapter->pcard_sd->supports_sdio_new_mode;
|
|
|
|
ENTER();
|
|
if (!new_mode && (port == CTRL_PORT)) {
|
|
/* Read the command response or event without aggr */
|
|
PRINTM(MINFO,
|
|
"card_2_host_mp_aggr: No aggr for control port\n");
|
|
|
|
f_do_rx_cur = 1;
|
|
goto rx_curr_single;
|
|
}
|
|
|
|
if (!pmadapter->pcard_sd->mpa_rx.enabled) {
|
|
PRINTM(MINFO,
|
|
"card_2_host_mp_aggr: rx aggregation disabled !\n");
|
|
|
|
f_do_rx_cur = 1;
|
|
goto rx_curr_single;
|
|
}
|
|
if ((new_mode &&
|
|
(pmadapter->pcard_sd->mp_rd_bitmap & reg->data_port_mask)) ||
|
|
(!new_mode && (pmadapter->pcard_sd->mp_rd_bitmap &
|
|
(~((t_u32)CTRL_PORT_MASK))))) {
|
|
/* Some more data RX pending */
|
|
PRINTM(MINFO, "card_2_host_mp_aggr: Not last packet\n");
|
|
|
|
if (MP_RX_AGGR_IN_PROGRESS(pmadapter)) {
|
|
if (MP_RX_AGGR_BUF_HAS_ROOM(pmadapter, rx_len)) {
|
|
f_aggr_cur = 1;
|
|
} else {
|
|
/* No room in Aggr buf, do rx aggr now */
|
|
f_do_rx_aggr = 1;
|
|
f_post_aggr_cur = 1;
|
|
}
|
|
} else {
|
|
/* Rx aggr not in progress */
|
|
f_aggr_cur = 1;
|
|
}
|
|
|
|
} else {
|
|
/* No more data RX pending */
|
|
PRINTM(MINFO, "card_2_host_mp_aggr: Last packet\n");
|
|
|
|
if (MP_RX_AGGR_IN_PROGRESS(pmadapter)) {
|
|
f_do_rx_aggr = 1;
|
|
if (MP_RX_AGGR_BUF_HAS_ROOM(pmadapter, rx_len)) {
|
|
f_aggr_cur = 1;
|
|
} else {
|
|
/* No room in Aggr buf, do rx aggr now */
|
|
f_do_rx_cur = 1;
|
|
}
|
|
} else {
|
|
f_do_rx_cur = 1;
|
|
}
|
|
}
|
|
|
|
if (f_aggr_cur) {
|
|
PRINTM(MINFO, "Current packet aggregation.\n");
|
|
/* Curr pkt can be aggregated */
|
|
if (new_mode)
|
|
MP_RX_AGGR_SETUP(pmadapter, pmbuf, port, rx_len);
|
|
else
|
|
MP_RX_AGGR_SETUP_NONEWMODE(pmadapter, pmbuf, port,
|
|
rx_len);
|
|
if (MP_RX_AGGR_PKT_LIMIT_REACHED(pmadapter) ||
|
|
((new_mode && MP_RX_AGGR_PORT_LIMIT_REACHED(pmadapter)) ||
|
|
(!new_mode &&
|
|
MP_RX_AGGR_PORT_LIMIT_REACHED_NONEWMODE(pmadapter)))) {
|
|
PRINTM(MINFO,
|
|
"card_2_host_mp_aggr: Aggregation Packet limit reached\n");
|
|
/* No more pkts allowed in Aggr buf, rx it */
|
|
f_do_rx_aggr = 1;
|
|
}
|
|
}
|
|
|
|
if (f_do_rx_aggr) {
|
|
/* do aggr RX now */
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
wlan_receive_mp_aggr_buf(pmadapter)) {
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
}
|
|
rx_curr_single:
|
|
if (f_do_rx_cur) {
|
|
PRINTM(MINFO, "RX: f_do_rx_cur: port: %d rx_len: %d\n", port,
|
|
rx_len);
|
|
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
wlan_sdio_card_to_host(
|
|
pmadapter, &pkt_type, (t_u32 *)&pmadapter->upld_len,
|
|
pmbuf, rx_len,
|
|
pmadapter->pcard_sd->ioport + port)) {
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
if (!new_mode &&
|
|
((port == CTRL_PORT) && ((pkt_type != MLAN_TYPE_EVENT) &&
|
|
(pkt_type != MLAN_TYPE_CMD)))) {
|
|
PRINTM(MERROR,
|
|
"Wrong pkt from CTRL PORT: type=%d, len=%dd\n",
|
|
pkt_type, pmbuf->data_len);
|
|
pmbuf->status_code = MLAN_ERROR_DATA_RX_FAIL;
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
if (new_mode || (port != CTRL_PORT)) {
|
|
if (pkt_type != MLAN_TYPE_DATA &&
|
|
pkt_type != MLAN_TYPE_SPA_DATA) {
|
|
PRINTM(MERROR,
|
|
"receive a wrong pkt from DATA PORT: type=%d, len=%dd\n",
|
|
pkt_type, pmbuf->data_len);
|
|
pmbuf->status_code = MLAN_ERROR_DATA_RX_FAIL;
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
}
|
|
|
|
if (new_mode || (port != CTRL_PORT))
|
|
pmadapter->pcard_sd->mpa_rx_count[0]++;
|
|
|
|
wlan_decode_rx_packet(pmadapter, pmbuf, pkt_type, MTRUE);
|
|
}
|
|
if (f_post_aggr_cur) {
|
|
PRINTM(MINFO, "Current packet aggregation.\n");
|
|
/* Curr pkt can be aggregated */
|
|
if (new_mode)
|
|
MP_RX_AGGR_SETUP(pmadapter, pmbuf, port, rx_len);
|
|
else
|
|
MP_RX_AGGR_SETUP_NONEWMODE(pmadapter, pmbuf, port,
|
|
rx_len);
|
|
}
|
|
done:
|
|
if (ret == MLAN_STATUS_FAILURE) {
|
|
if (MP_RX_AGGR_IN_PROGRESS(pmadapter)) {
|
|
/* MP-A transfer failed - cleanup */
|
|
for (pind = 0;
|
|
pind < pmadapter->pcard_sd->mpa_rx.pkt_cnt;
|
|
pind++) {
|
|
wlan_free_mlan_buffer(
|
|
pmadapter, pmadapter->pcard_sd->mpa_rx
|
|
.mbuf_arr[pind]);
|
|
}
|
|
MP_RX_AGGR_BUF_RESET(pmadapter);
|
|
}
|
|
|
|
if (f_do_rx_cur) {
|
|
/* Single Transfer pending */
|
|
/* Free curr buff also */
|
|
wlan_free_mlan_buffer(pmadapter, pmbuf);
|
|
}
|
|
}
|
|
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function sends aggr buf
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
mlan_status wlan_send_mp_aggr_buf(mlan_adapter *pmadapter)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
t_u32 cmd53_port = 0;
|
|
t_u32 port_count = 0;
|
|
mlan_buffer mbuf_aggr;
|
|
t_u8 i = 0;
|
|
t_u8 mp_aggr_pkt_limit = pmadapter->pcard_sd->mp_aggr_pkt_limit;
|
|
t_bool new_mode = pmadapter->pcard_sd->supports_sdio_new_mode;
|
|
|
|
ENTER();
|
|
|
|
if (!pmadapter->pcard_sd->mpa_tx.pkt_cnt) {
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
PRINTM(MINFO,
|
|
"host_2_card_mp_aggr: Send aggregation buffer."
|
|
"%d %d\n",
|
|
pmadapter->pcard_sd->mpa_tx.start_port,
|
|
pmadapter->pcard_sd->mpa_tx.ports);
|
|
|
|
memset(pmadapter, &mbuf_aggr, 0, sizeof(mlan_buffer));
|
|
|
|
if (!pmadapter->pcard_sd->mpa_tx.buf &&
|
|
pmadapter->pcard_sd->mpa_tx.pkt_cnt > 1) {
|
|
mbuf_aggr.data_len = pmadapter->pcard_sd->mpa_tx.buf_len;
|
|
mbuf_aggr.pnext = mbuf_aggr.pprev = &mbuf_aggr;
|
|
mbuf_aggr.use_count = 0;
|
|
for (i = 0; i < pmadapter->pcard_sd->mpa_tx.pkt_cnt; i++)
|
|
wlan_link_buf_to_aggr(
|
|
&mbuf_aggr,
|
|
pmadapter->pcard_sd->mpa_tx.mbuf_arr[i]);
|
|
} else {
|
|
mbuf_aggr.pbuf = (t_u8 *)pmadapter->pcard_sd->mpa_tx.buf;
|
|
mbuf_aggr.data_len = pmadapter->pcard_sd->mpa_tx.buf_len;
|
|
}
|
|
|
|
if (new_mode) {
|
|
port_count = bitcount(pmadapter->pcard_sd->mpa_tx.ports) - 1;
|
|
cmd53_port = (pmadapter->pcard_sd->ioport | SDIO_MPA_ADDR_BASE |
|
|
(port_count << 8)) +
|
|
pmadapter->pcard_sd->mpa_tx.start_port;
|
|
} else {
|
|
cmd53_port = (pmadapter->pcard_sd->ioport | SDIO_MPA_ADDR_BASE |
|
|
(pmadapter->pcard_sd->mpa_tx.ports << 4)) +
|
|
pmadapter->pcard_sd->mpa_tx.start_port;
|
|
}
|
|
if (pmadapter->pcard_sd->mpa_tx.pkt_cnt == 1)
|
|
cmd53_port = pmadapter->pcard_sd->ioport +
|
|
pmadapter->pcard_sd->mpa_tx.start_port;
|
|
/** only one packet */
|
|
if (!pmadapter->pcard_sd->mpa_tx.buf &&
|
|
pmadapter->pcard_sd->mpa_tx.pkt_cnt == 1)
|
|
ret = wlan_write_data_sync(
|
|
pmadapter, pmadapter->pcard_sd->mpa_tx.mbuf_arr[0],
|
|
cmd53_port);
|
|
else
|
|
ret = wlan_write_data_sync(pmadapter, &mbuf_aggr, cmd53_port);
|
|
if (!pmadapter->pcard_sd->mpa_tx.buf) {
|
|
/** free mlan buffer */
|
|
for (i = 0; i < pmadapter->pcard_sd->mpa_tx.pkt_cnt; i++) {
|
|
wlan_write_data_complete(
|
|
pmadapter,
|
|
pmadapter->pcard_sd->mpa_tx.mbuf_arr[i],
|
|
MLAN_STATUS_SUCCESS);
|
|
}
|
|
}
|
|
if (!(pmadapter->pcard_sd->mp_wr_bitmap &
|
|
(1 << pmadapter->pcard_sd->curr_wr_port)) &&
|
|
(pmadapter->pcard_sd->mpa_tx.pkt_cnt < mp_aggr_pkt_limit))
|
|
pmadapter->pcard_sd->mpa_sent_no_ports++;
|
|
pmadapter->pcard_sd
|
|
->mpa_tx_count[pmadapter->pcard_sd->mpa_tx.pkt_cnt - 1]++;
|
|
pmadapter->pcard_sd
|
|
->last_mp_wr_bitmap[pmadapter->pcard_sd->last_mp_index] =
|
|
pmadapter->pcard_sd->mp_wr_bitmap;
|
|
pmadapter->pcard_sd
|
|
->last_mp_wr_ports[pmadapter->pcard_sd->last_mp_index] =
|
|
cmd53_port;
|
|
pmadapter->pcard_sd->last_mp_wr_len[pmadapter->pcard_sd->last_mp_index] =
|
|
pmadapter->pcard_sd->mpa_tx.buf_len;
|
|
pmadapter->pcard_sd
|
|
->last_curr_wr_port[pmadapter->pcard_sd->last_mp_index] =
|
|
pmadapter->pcard_sd->curr_wr_port;
|
|
memcpy_ext(
|
|
pmadapter,
|
|
(t_u8 *)&pmadapter->pcard_sd
|
|
->last_mp_wr_info[pmadapter->pcard_sd->last_mp_index *
|
|
mp_aggr_pkt_limit],
|
|
(t_u8 *)pmadapter->pcard_sd->mpa_tx.mp_wr_info,
|
|
mp_aggr_pkt_limit * sizeof(t_u16),
|
|
mp_aggr_pkt_limit * sizeof(t_u16));
|
|
pmadapter->pcard_sd->last_mp_index++;
|
|
if (pmadapter->pcard_sd->last_mp_index >= SDIO_MP_DBG_NUM)
|
|
pmadapter->pcard_sd->last_mp_index = 0;
|
|
MP_TX_AGGR_BUF_RESET(pmadapter);
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function sends data to the card in SDIO aggregated mode.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param mbuf A pointer to the SDIO data/cmd buffer
|
|
* @param port current port for aggregation
|
|
* @param next_pkt_len Length of next packet used for multiport aggregation
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_host_to_card_mp_aggr(mlan_adapter *pmadapter,
|
|
mlan_buffer *mbuf, t_u8 port,
|
|
t_u32 next_pkt_len)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
t_s32 f_send_aggr_buf = 0;
|
|
t_s32 f_send_cur_buf = 0;
|
|
t_s32 f_precopy_cur_buf = 0;
|
|
t_s32 f_postcopy_cur_buf = 0;
|
|
t_u8 aggr_sg = 0;
|
|
t_u8 mp_aggr_pkt_limit = pmadapter->pcard_sd->mp_aggr_pkt_limit;
|
|
t_bool new_mode = pmadapter->pcard_sd->supports_sdio_new_mode;
|
|
|
|
ENTER();
|
|
|
|
PRINTM(MIF_D, "host_2_card_mp_aggr: next_pkt_len: %d curr_port:%d\n",
|
|
next_pkt_len, port);
|
|
|
|
if (!pmadapter->pcard_sd->mpa_tx.enabled) {
|
|
PRINTM(MINFO,
|
|
"host_2_card_mp_aggr: tx aggregation disabled !\n");
|
|
f_send_cur_buf = 1;
|
|
goto tx_curr_single;
|
|
}
|
|
|
|
if (next_pkt_len) {
|
|
/* More pkt in TX queue */
|
|
PRINTM(MINFO, "host_2_card_mp_aggr: More packets in Queue.\n");
|
|
|
|
if (MP_TX_AGGR_IN_PROGRESS(pmadapter)) {
|
|
if (MP_TX_AGGR_BUF_HAS_ROOM(pmadapter, mbuf,
|
|
mbuf->data_len)) {
|
|
f_precopy_cur_buf = 1;
|
|
|
|
if (!(pmadapter->pcard_sd->mp_wr_bitmap &
|
|
(1
|
|
<< pmadapter->pcard_sd->curr_wr_port)) ||
|
|
!MP_TX_AGGR_BUF_HAS_ROOM(
|
|
pmadapter, mbuf,
|
|
mbuf->data_len + next_pkt_len)) {
|
|
f_send_aggr_buf = 1;
|
|
}
|
|
} else {
|
|
/* No room in Aggr buf, send it */
|
|
f_send_aggr_buf = 1;
|
|
|
|
if (!(pmadapter->pcard_sd->mp_wr_bitmap &
|
|
(1
|
|
<< pmadapter->pcard_sd->curr_wr_port))) {
|
|
f_send_cur_buf = 1;
|
|
} else {
|
|
f_postcopy_cur_buf = 1;
|
|
}
|
|
}
|
|
} else {
|
|
if (MP_TX_AGGR_BUF_HAS_ROOM(pmadapter, mbuf,
|
|
mbuf->data_len) &&
|
|
(pmadapter->pcard_sd->mp_wr_bitmap &
|
|
(1 << pmadapter->pcard_sd->curr_wr_port)))
|
|
f_precopy_cur_buf = 1;
|
|
else
|
|
f_send_cur_buf = 1;
|
|
}
|
|
} else {
|
|
/* Last pkt in TX queue */
|
|
PRINTM(MINFO,
|
|
"host_2_card_mp_aggr: Last packet in Tx Queue.\n");
|
|
|
|
if (MP_TX_AGGR_IN_PROGRESS(pmadapter)) {
|
|
/* some packs in Aggr buf already */
|
|
f_send_aggr_buf = 1;
|
|
|
|
if (MP_TX_AGGR_BUF_HAS_ROOM(pmadapter, mbuf,
|
|
mbuf->data_len)) {
|
|
f_precopy_cur_buf = 1;
|
|
} else {
|
|
/* No room in Aggr buf, send it */
|
|
f_send_cur_buf = 1;
|
|
}
|
|
} else {
|
|
f_send_cur_buf = 1;
|
|
}
|
|
pmadapter->pcard_sd->mpa_sent_last_pkt++;
|
|
}
|
|
|
|
if (f_precopy_cur_buf) {
|
|
PRINTM(MINFO, "host_2_card_mp_aggr: Precopy current buffer\n");
|
|
if (pmadapter->pcard_sd->mpa_buf)
|
|
memcpy_ext(
|
|
pmadapter,
|
|
pmadapter->pcard_sd->mpa_buf +
|
|
(pmadapter->pcard_sd->last_mp_index *
|
|
mp_aggr_pkt_limit +
|
|
pmadapter->pcard_sd->mpa_tx.pkt_cnt) *
|
|
MLAN_SDIO_BLOCK_SIZE,
|
|
mbuf->pbuf + mbuf->data_offset,
|
|
MLAN_SDIO_BLOCK_SIZE, MLAN_SDIO_BLOCK_SIZE);
|
|
if (!pmadapter->pcard_sd->mpa_tx.buf) {
|
|
if (new_mode)
|
|
MP_TX_AGGR_BUF_PUT_SG(pmadapter, mbuf, port);
|
|
else
|
|
MP_TX_AGGR_BUF_PUT_SG_NONEWMODE(pmadapter, mbuf,
|
|
port);
|
|
aggr_sg = MTRUE;
|
|
} else {
|
|
if (new_mode)
|
|
MP_TX_AGGR_BUF_PUT(pmadapter, mbuf, port);
|
|
else
|
|
MP_TX_AGGR_BUF_PUT_NONEWMODE(pmadapter, mbuf,
|
|
port);
|
|
}
|
|
if (MP_TX_AGGR_PKT_LIMIT_REACHED(pmadapter) ||
|
|
(!new_mode && MP_TX_AGGR_PORT_LIMIT_REACHED(pmadapter))) {
|
|
PRINTM(MIF_D,
|
|
"host_2_card_mp_aggr: Aggregation Pkt limit reached\n");
|
|
/* No more pkts allowed in Aggr buf, send it */
|
|
f_send_aggr_buf = 1;
|
|
}
|
|
}
|
|
|
|
if (f_send_aggr_buf)
|
|
ret = wlan_send_mp_aggr_buf(pmadapter);
|
|
|
|
tx_curr_single:
|
|
if (f_send_cur_buf) {
|
|
PRINTM(MINFO, "host_2_card_mp_aggr: writing to port #%d\n",
|
|
port);
|
|
ret = wlan_write_data_sync(pmadapter, mbuf,
|
|
pmadapter->pcard_sd->ioport + port);
|
|
if (!(pmadapter->pcard_sd->mp_wr_bitmap &
|
|
(1 << pmadapter->pcard_sd->curr_wr_port)))
|
|
pmadapter->pcard_sd->mpa_sent_no_ports++;
|
|
pmadapter->pcard_sd
|
|
->last_mp_wr_bitmap[pmadapter->pcard_sd->last_mp_index] =
|
|
pmadapter->pcard_sd->mp_wr_bitmap;
|
|
pmadapter->pcard_sd
|
|
->last_mp_wr_ports[pmadapter->pcard_sd->last_mp_index] =
|
|
pmadapter->pcard_sd->ioport + port;
|
|
pmadapter->pcard_sd
|
|
->last_mp_wr_len[pmadapter->pcard_sd->last_mp_index] =
|
|
mbuf->data_len;
|
|
memset(pmadapter,
|
|
(t_u8 *)&pmadapter->pcard_sd->last_mp_wr_info
|
|
[pmadapter->pcard_sd->last_mp_index *
|
|
mp_aggr_pkt_limit],
|
|
0, sizeof(t_u16) * mp_aggr_pkt_limit);
|
|
pmadapter->pcard_sd
|
|
->last_mp_wr_info[pmadapter->pcard_sd->last_mp_index *
|
|
mp_aggr_pkt_limit] =
|
|
*(t_u16 *)(mbuf->pbuf + mbuf->data_offset);
|
|
pmadapter->pcard_sd
|
|
->last_curr_wr_port[pmadapter->pcard_sd->last_mp_index] =
|
|
pmadapter->pcard_sd->curr_wr_port;
|
|
if (pmadapter->pcard_sd->mpa_buf)
|
|
memcpy_ext(pmadapter,
|
|
pmadapter->pcard_sd->mpa_buf +
|
|
(pmadapter->pcard_sd->last_mp_index *
|
|
mp_aggr_pkt_limit *
|
|
MLAN_SDIO_BLOCK_SIZE),
|
|
mbuf->pbuf + mbuf->data_offset,
|
|
MLAN_SDIO_BLOCK_SIZE, MLAN_SDIO_BLOCK_SIZE);
|
|
pmadapter->pcard_sd->last_mp_index++;
|
|
if (pmadapter->pcard_sd->last_mp_index >= SDIO_MP_DBG_NUM)
|
|
pmadapter->pcard_sd->last_mp_index = 0;
|
|
pmadapter->pcard_sd->mpa_tx_count[0]++;
|
|
}
|
|
if (f_postcopy_cur_buf) {
|
|
PRINTM(MINFO, "host_2_card_mp_aggr: Postcopy current buffer\n");
|
|
if (pmadapter->pcard_sd->mpa_buf)
|
|
memcpy_ext(
|
|
pmadapter,
|
|
pmadapter->pcard_sd->mpa_buf +
|
|
(pmadapter->pcard_sd->last_mp_index *
|
|
mp_aggr_pkt_limit +
|
|
pmadapter->pcard_sd->mpa_tx.pkt_cnt) *
|
|
MLAN_SDIO_BLOCK_SIZE,
|
|
mbuf->pbuf + mbuf->data_offset,
|
|
MLAN_SDIO_BLOCK_SIZE, MLAN_SDIO_BLOCK_SIZE);
|
|
if (!pmadapter->pcard_sd->mpa_tx.buf) {
|
|
if (new_mode)
|
|
MP_TX_AGGR_BUF_PUT_SG(pmadapter, mbuf, port);
|
|
else
|
|
MP_TX_AGGR_BUF_PUT_SG_NONEWMODE(pmadapter, mbuf,
|
|
port);
|
|
aggr_sg = MTRUE;
|
|
} else {
|
|
if (new_mode)
|
|
MP_TX_AGGR_BUF_PUT(pmadapter, mbuf, port);
|
|
else
|
|
MP_TX_AGGR_BUF_PUT_NONEWMODE(pmadapter, mbuf,
|
|
port);
|
|
}
|
|
}
|
|
/* Always return PENDING in SG mode */
|
|
if (aggr_sg)
|
|
ret = MLAN_STATUS_PENDING;
|
|
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/********************************************************
|
|
Global functions
|
|
********************************************************/
|
|
|
|
/**
|
|
* @brief This function checks if the interface is ready to download
|
|
* or not while other download interface is present
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param val Winner status (0: winner)
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*
|
|
*/
|
|
static mlan_status wlan_sdio_check_winner_status(mlan_adapter *pmadapter,
|
|
t_u32 *val)
|
|
{
|
|
t_u32 winner = 0;
|
|
pmlan_callbacks pcb;
|
|
t_u8 card_winner_check_reg = pmadapter->pcard_sd->reg->winner_check_reg;
|
|
|
|
ENTER();
|
|
|
|
#ifdef SD8801
|
|
if (IS_SD8801(pmadapter->card_type)) {
|
|
*val = 0;
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
#endif
|
|
pcb = &pmadapter->callbacks;
|
|
|
|
if (MLAN_STATUS_SUCCESS != pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
card_winner_check_reg,
|
|
&winner)) {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
*val = winner;
|
|
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief This function checks if the firmware is ready to accept
|
|
* command or not.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param pollnum Maximum polling number
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_check_fw_status(mlan_adapter *pmadapter,
|
|
t_u32 pollnum)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
t_u16 firmwarestat = 0;
|
|
t_u32 tries;
|
|
|
|
ENTER();
|
|
|
|
/* Wait for firmware initialization event */
|
|
for (tries = 0; tries < pollnum; tries++) {
|
|
ret = wlan_sdio_read_fw_status(pmadapter, &firmwarestat);
|
|
if (MLAN_STATUS_SUCCESS != ret)
|
|
continue;
|
|
if (firmwarestat == SDIO_FIRMWARE_READY) {
|
|
ret = MLAN_STATUS_SUCCESS;
|
|
break;
|
|
} else {
|
|
wlan_mdelay(pmadapter, 10);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
}
|
|
}
|
|
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
if (pollnum > 1)
|
|
PRINTM(MERROR,
|
|
"Fail to poll firmware status: firmwarestat=0x%x\n",
|
|
firmwarestat);
|
|
goto done;
|
|
}
|
|
|
|
done:
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function enables the host interrupts.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_enable_sdio_host_int(pmlan_adapter pmadapter)
|
|
{
|
|
mlan_status ret;
|
|
t_u8 mask = pmadapter->pcard_sd->reg->host_int_enable;
|
|
|
|
ENTER();
|
|
ret = wlan_sdio_enable_host_int_mask(pmadapter, mask);
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function downloads firmware to card
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter
|
|
* @param pmfw A pointer to firmware image
|
|
*
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_dnld_fw(pmlan_adapter pmadapter,
|
|
pmlan_fw_image pmfw)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
t_u32 poll_num = 1;
|
|
t_u32 winner = 0;
|
|
|
|
ENTER();
|
|
|
|
/*when using GPIO wakeup, don't run the below code.
|
|
*if using GPIO wakeup, host will do handshake with FW
|
|
*to check if FW wake up and pull up SDIO line, then reload driver.
|
|
*So when using GPIO wakeup, don't need driver to do check wakeup status
|
|
*again. when using SDIO interface wakeup, run the below code; if using
|
|
*SDIO interface wakeup, driver need to do check wakeup status with FW.
|
|
*/
|
|
|
|
/* Card specific probing */
|
|
ret = wlan_sdio_probe(pmadapter);
|
|
if (ret == MLAN_STATUS_FAILURE) {
|
|
PRINTM(MERROR, "WLAN SDIO probe failed\n", ret);
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/* Check if firmware is already running */
|
|
ret = wlan_sdio_check_fw_status(pmadapter, poll_num);
|
|
if (ret == MLAN_STATUS_SUCCESS) {
|
|
#if defined(SDIO)
|
|
if (pmfw->fw_reload == FW_RELOAD_SDIO_INBAND_RESET) {
|
|
PRINTM(MMSG, "Try reset fw in mlan\n");
|
|
ret = wlan_reset_fw(pmadapter);
|
|
if (ret == MLAN_STATUS_FAILURE) {
|
|
PRINTM(MERROR, "FW reset failure!");
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
} else {
|
|
#endif
|
|
PRINTM(MMSG,
|
|
"WLAN FW already running! Skip FW download\n");
|
|
#if defined(SDIO)
|
|
pmadapter->ops.wakeup_card(pmadapter, MFALSE);
|
|
#endif
|
|
goto done;
|
|
#if defined(SDIO)
|
|
}
|
|
#endif
|
|
}
|
|
poll_num = MAX_FIRMWARE_POLL_TRIES;
|
|
/* Check if other interface is downloading */
|
|
ret = wlan_sdio_check_winner_status(pmadapter, &winner);
|
|
if (ret == MLAN_STATUS_FAILURE) {
|
|
PRINTM(MFATAL, "WLAN read winner status failed!\n");
|
|
goto done;
|
|
}
|
|
if (winner) {
|
|
PRINTM(MMSG,
|
|
"WLAN is not the winner (0x%x). Skip FW download\n",
|
|
winner);
|
|
poll_num = MAX_MULTI_INTERFACE_POLL_TRIES;
|
|
goto poll_fw;
|
|
}
|
|
|
|
/* Download the firmware image via helper */
|
|
ret = wlan_sdio_prog_fw_w_helper(pmadapter, pmfw->pfw_buf,
|
|
pmfw->fw_len);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR, "wlan_dnld_fw fail ret=0x%x\n", ret);
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
poll_fw:
|
|
/* Check if the firmware is downloaded successfully or not */
|
|
ret = wlan_sdio_check_fw_status(pmadapter, poll_num);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MFATAL, "FW failed to be active in time!\n");
|
|
ret = MLAN_STATUS_FAILURE;
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
#ifdef SD9177
|
|
if (IS_SD9177(pmadapter->card_type))
|
|
wlan_mdelay(pmadapter, 1000);
|
|
#endif
|
|
done:
|
|
|
|
/* re-enable host interrupt for mlan after fw dnld is successful */
|
|
wlan_enable_sdio_host_int(pmadapter);
|
|
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function probes the driver
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
mlan_status wlan_sdio_probe(pmlan_adapter pmadapter)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
t_u32 sdio_ireg = 0;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
|
|
ENTER();
|
|
/*
|
|
* Read the HOST_INT_STATUS_REG for ACK the first interrupt got
|
|
* from the bootloader. If we don't do this we get a interrupt
|
|
* as soon as we register the irq.
|
|
*/
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
pmadapter->pcard_sd->reg->host_int_status_reg,
|
|
&sdio_ireg);
|
|
|
|
/* Disable host interrupt mask register for SDIO */
|
|
ret = wlan_disable_sdio_host_int(pmadapter);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
/* Get SDIO ioport */
|
|
ret = wlan_sdio_init_ioport(pmadapter);
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function get sdio device from card type
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
mlan_status wlan_get_sdio_device(pmlan_adapter pmadapter)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
t_u16 card_type = pmadapter->card_type;
|
|
|
|
ENTER();
|
|
|
|
ret = pmadapter->callbacks.moal_malloc(pmadapter->pmoal_handle,
|
|
sizeof(mlan_sdio_card),
|
|
MLAN_MEM_DEF,
|
|
(t_u8 **)&pmadapter->pcard_sd);
|
|
if (ret != MLAN_STATUS_SUCCESS || !pmadapter->pcard_sd) {
|
|
PRINTM(MERROR, "Failed to allocate pcard_sd\n");
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
pmadapter->pcard_sd->max_ports = MAX_PORT;
|
|
pmadapter->pcard_sd->mp_aggr_pkt_limit = SDIO_MP_AGGR_DEF_PKT_LIMIT;
|
|
pmadapter->pcard_sd->supports_sdio_new_mode = MTRUE;
|
|
pmadapter->pcard_sd->mp_tx_aggr_buf_size = SDIO_MP_AGGR_BUF_SIZE_MAX;
|
|
pmadapter->pcard_sd->mp_rx_aggr_buf_size = SDIO_MP_AGGR_BUF_SIZE_MAX;
|
|
|
|
switch (card_type) {
|
|
#ifdef SD8801
|
|
case CARD_TYPE_SD8801:
|
|
pmadapter->pcard_sd->reg = &mlan_reg_sd8801;
|
|
pmadapter->pcard_info = &mlan_card_info_sd8801;
|
|
pmadapter->pcard_sd->max_ports = MAX_PORT_16;
|
|
pmadapter->pcard_sd->mp_aggr_pkt_limit =
|
|
SDIO_MP_AGGR_DEF_PKT_LIMIT_8;
|
|
pmadapter->pcard_sd->supports_sdio_new_mode = MFALSE;
|
|
pmadapter->pcard_sd->mp_tx_aggr_buf_size =
|
|
SDIO_MP_AGGR_BUF_SIZE_32K;
|
|
pmadapter->pcard_sd->mp_rx_aggr_buf_size =
|
|
SDIO_MP_AGGR_BUF_SIZE_32K;
|
|
break;
|
|
#endif
|
|
#ifdef SD8887
|
|
case CARD_TYPE_SD8887:
|
|
pmadapter->pcard_sd->reg = &mlan_reg_sd8887;
|
|
pmadapter->pcard_info = &mlan_card_info_sd8887;
|
|
break;
|
|
#endif
|
|
#ifdef SD8897
|
|
case CARD_TYPE_SD8897:
|
|
pmadapter->pcard_sd->reg = &mlan_reg_sd8897;
|
|
pmadapter->pcard_info = &mlan_card_info_sd8897;
|
|
break;
|
|
#endif
|
|
#if defined(SD8977) || defined(SD8978)
|
|
case CARD_TYPE_SD8977:
|
|
case CARD_TYPE_SD8978:
|
|
pmadapter->pcard_sd->reg = &mlan_reg_sd8977_sd8997;
|
|
pmadapter->pcard_info = &mlan_card_info_sd8977;
|
|
break;
|
|
#endif
|
|
#ifdef SD8997
|
|
case CARD_TYPE_SD8997:
|
|
pmadapter->pcard_sd->reg = &mlan_reg_sd8977_sd8997;
|
|
pmadapter->pcard_info = &mlan_card_info_sd8997;
|
|
break;
|
|
#endif
|
|
#ifdef SD8987
|
|
case CARD_TYPE_SD8987:
|
|
pmadapter->pcard_sd->reg = &mlan_reg_sd8977_sd8997;
|
|
pmadapter->pcard_info = &mlan_card_info_sd8987;
|
|
break;
|
|
#endif
|
|
#ifdef SD9098
|
|
case CARD_TYPE_SD9098:
|
|
pmadapter->pcard_sd->reg = &mlan_reg_sd8977_sd8997;
|
|
pmadapter->pcard_info = &mlan_card_info_sd9098;
|
|
break;
|
|
#endif
|
|
#ifdef SD9097
|
|
case CARD_TYPE_SD9097:
|
|
pmadapter->pcard_sd->reg = &mlan_reg_sd8977_sd8997;
|
|
pmadapter->pcard_info = &mlan_card_info_sd9097;
|
|
break;
|
|
#endif
|
|
#ifdef SDNW62X
|
|
case CARD_TYPE_SDNW62X:
|
|
pmadapter->pcard_sd->reg = &mlan_reg_sd8977_sd8997;
|
|
pmadapter->pcard_info = &mlan_card_info_sdnw62x;
|
|
break;
|
|
#endif
|
|
#ifdef SD9177
|
|
case CARD_TYPE_SD9177:
|
|
pmadapter->pcard_sd->reg = &mlan_reg_sd8977_sd8997;
|
|
pmadapter->pcard_info = &mlan_card_info_sd9177;
|
|
break;
|
|
#endif
|
|
default:
|
|
PRINTM(MERROR, "can't get right card type \n");
|
|
ret = MLAN_STATUS_FAILURE;
|
|
break;
|
|
}
|
|
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function dump the mp registers when issue happened
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @return N/A
|
|
*/
|
|
void wlan_dump_mp_registers(pmlan_adapter pmadapter)
|
|
{
|
|
t_u32 mp_wr_bitmap;
|
|
t_bool new_mode = pmadapter->pcard_sd->supports_sdio_new_mode;
|
|
t_u32 mp_rd_bitmap;
|
|
t_u16 rx_len = 0;
|
|
const mlan_sdio_card_reg *reg = pmadapter->pcard_sd->reg;
|
|
t_u8 cmd_rd_len_0 = reg->cmd_rd_len_0;
|
|
t_u8 cmd_rd_len_1 = reg->cmd_rd_len_1;
|
|
t_u8 host_int_status_reg = reg->host_int_status_reg;
|
|
t_u32 sdio_ireg = 0;
|
|
|
|
mp_wr_bitmap = (t_u32)pmadapter->pcard_sd->mp_regs[reg->wr_bitmap_l];
|
|
mp_wr_bitmap |= ((t_u32)pmadapter->pcard_sd->mp_regs[reg->wr_bitmap_u])
|
|
<< 8;
|
|
if (new_mode) {
|
|
mp_wr_bitmap |=
|
|
((t_u32)pmadapter->pcard_sd->mp_regs[reg->wr_bitmap_1l])
|
|
<< 16;
|
|
mp_wr_bitmap |=
|
|
((t_u32)pmadapter->pcard_sd->mp_regs[reg->wr_bitmap_1u])
|
|
<< 24;
|
|
}
|
|
PRINTM(MMSG, "wlan: mp_data_port_mask = 0x%x\n",
|
|
pmadapter->pcard_sd->mp_data_port_mask);
|
|
PRINTM(MMSG, "wlan: HW wr_bitmap=0x%08x Host: wr_bitmap=0x%08x\n",
|
|
mp_wr_bitmap, pmadapter->pcard_sd->mp_wr_bitmap);
|
|
mp_rd_bitmap = (t_u32)pmadapter->pcard_sd->mp_regs[reg->rd_bitmap_l];
|
|
mp_rd_bitmap |= ((t_u32)pmadapter->pcard_sd->mp_regs[reg->rd_bitmap_u])
|
|
<< 8;
|
|
if (new_mode) {
|
|
mp_rd_bitmap |=
|
|
((t_u32)pmadapter->pcard_sd->mp_regs[reg->rd_bitmap_1l])
|
|
<< 16;
|
|
mp_rd_bitmap |=
|
|
((t_u32)pmadapter->pcard_sd->mp_regs[reg->rd_bitmap_1u])
|
|
<< 24;
|
|
}
|
|
PRINTM(MMSG, "wlan: HW rd_bitmap=0x%08x Host: rd_bitmap=0x%08x\n",
|
|
mp_rd_bitmap, pmadapter->pcard_sd->mp_rd_bitmap);
|
|
|
|
if (new_mode) {
|
|
rx_len = ((t_u16)pmadapter->pcard_sd->mp_regs[cmd_rd_len_1])
|
|
<< 8;
|
|
rx_len |= (t_u16)pmadapter->pcard_sd->mp_regs[cmd_rd_len_0];
|
|
PRINTM(MMSG, "wlan: cmd rx buffer rx_len = %d\n", rx_len);
|
|
}
|
|
PRINTM(MMSG, "wlan: HW sdio_ireg = 0x%x\n",
|
|
pmadapter->pcard_sd->mp_regs[host_int_status_reg]);
|
|
sdio_ireg = pmadapter->pcard_sd->mp_regs[host_int_status_reg];
|
|
|
|
if (new_mode && rx_len)
|
|
sdio_ireg |= UP_LD_CMD_PORT_HOST_INT_STATUS;
|
|
|
|
if (!(pmadapter->pcard_sd->mp_wr_bitmap &
|
|
pmadapter->pcard_sd->mp_data_port_mask)) {
|
|
if (mp_wr_bitmap & pmadapter->pcard_sd->mp_data_port_mask)
|
|
sdio_ireg |= DN_LD_HOST_INT_STATUS;
|
|
}
|
|
|
|
if ((!pmadapter->pcard_sd->mp_rd_bitmap) && mp_rd_bitmap)
|
|
sdio_ireg |= UP_LD_HOST_INT_STATUS;
|
|
|
|
pmadapter->pcard_sd->mp_regs[host_int_status_reg] = sdio_ireg;
|
|
PRINTM(MMSG, "wlan: recovered sdio_ireg=0x%x\n", sdio_ireg);
|
|
return;
|
|
}
|
|
|
|
/**
|
|
* @brief This function gets interrupt status.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @return MLAN_STATUS_SUCCESS
|
|
*/
|
|
static mlan_status wlan_sdio_interrupt(t_u16 msg_id, pmlan_adapter pmadapter)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
mlan_buffer mbuf;
|
|
t_u32 sdio_ireg = 0;
|
|
t_u8 offset = 0;
|
|
t_u8 i = 0;
|
|
int max_mp_regs = pmadapter->pcard_sd->reg->max_mp_regs;
|
|
t_u8 host_int_status_reg =
|
|
pmadapter->pcard_sd->reg->host_int_status_reg;
|
|
|
|
ENTER();
|
|
|
|
while (max_mp_regs) {
|
|
memset(pmadapter, &mbuf, 0, sizeof(mlan_buffer));
|
|
mbuf.pbuf = pmadapter->pcard_sd->mp_regs + offset;
|
|
mbuf.data_len = MIN(max_mp_regs, MLAN_SDIO_BLOCK_SIZE);
|
|
do {
|
|
ret = pcb->moal_read_data_sync(
|
|
pmadapter->pmoal_handle, &mbuf,
|
|
(REG_PORT + offset) | MLAN_SDIO_BYTE_MODE_MASK,
|
|
0);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"wlan: cmd53 read regs failed: %d port=%x retry=%d\n",
|
|
ret, REG_PORT + offset, i);
|
|
i++;
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
HOST_TO_CARD_EVENT_REG,
|
|
HOST_TERM_CMD53);
|
|
if (i > MAX_WRITE_IOMEM_RETRY) {
|
|
PRINTM(MERROR,
|
|
"wlan: Fail to read mp_regs\n");
|
|
pmadapter->dbg.num_int_read_failure++;
|
|
goto done;
|
|
}
|
|
}
|
|
} while (ret == MLAN_STATUS_FAILURE);
|
|
offset += mbuf.data_len;
|
|
max_mp_regs -= mbuf.data_len;
|
|
}
|
|
if (i > 0)
|
|
wlan_dump_mp_registers(pmadapter);
|
|
|
|
DBG_HEXDUMP(MIF_D, "SDIO MP Registers", pmadapter->pcard_sd->mp_regs,
|
|
max_mp_regs);
|
|
sdio_ireg = pmadapter->pcard_sd->mp_regs[host_int_status_reg];
|
|
pmadapter->dbg.last_int_status = pmadapter->ireg | sdio_ireg;
|
|
if (sdio_ireg) {
|
|
/*
|
|
* DN_LD_HOST_INT_STATUS and/or UP_LD_HOST_INT_STATUS
|
|
* DN_LD_CMD_PORT_HOST_INT_STATUS and/or
|
|
* UP_LD_CMD_PORT_HOST_INT_STATUS
|
|
* Clear the interrupt status register
|
|
*/
|
|
PRINTM(MINTR, "wlan_interrupt: sdio_ireg = 0x%x\n", sdio_ireg);
|
|
pmadapter->pcard_sd->num_of_irq++;
|
|
pcb->moal_spin_lock(pmadapter->pmoal_handle,
|
|
pmadapter->pint_lock);
|
|
pmadapter->ireg |= sdio_ireg;
|
|
pcb->moal_spin_unlock(pmadapter->pmoal_handle,
|
|
pmadapter->pint_lock);
|
|
if (!pmadapter->pps_uapsd_mode &&
|
|
pmadapter->ps_state == PS_STATE_SLEEP) {
|
|
pmadapter->pm_wakeup_fw_try = MFALSE;
|
|
pmadapter->ps_state = PS_STATE_AWAKE;
|
|
pmadapter->pm_wakeup_card_req = MFALSE;
|
|
}
|
|
} else {
|
|
PRINTM(MMSG, "wlan_interrupt: sdio_ireg = 0x%x\n", sdio_ireg);
|
|
}
|
|
done:
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief This function try to read the packet when fail to alloc rx buffer
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param port Current port on which packet needs to be rxed
|
|
* @param rx_len Length of received packet
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_card_to_host_recovery(mlan_adapter *pmadapter,
|
|
t_u8 port, t_u16 rx_len)
|
|
{
|
|
mlan_buffer mbuf;
|
|
t_u32 pkt_type = 0;
|
|
mlan_status ret = MLAN_STATUS_FAILURE;
|
|
ENTER();
|
|
if (!pmadapter->pcard_sd->supports_sdio_new_mode)
|
|
goto done;
|
|
if (MP_RX_AGGR_IN_PROGRESS(pmadapter)) {
|
|
PRINTM(MDATA, "Recovery:do Rx Aggr\n");
|
|
/* do aggr RX now */
|
|
wlan_receive_mp_aggr_buf(pmadapter);
|
|
}
|
|
memset(pmadapter, &mbuf, 0, sizeof(mlan_buffer));
|
|
mbuf.pbuf = pmadapter->pcard_sd->rx_buf;
|
|
mbuf.data_len = rx_len;
|
|
|
|
PRINTM(MDATA, "Recovery: Try read port=%d rx_len=%d\n", port, rx_len);
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
wlan_sdio_card_to_host(pmadapter, &pkt_type,
|
|
(t_u32 *)&pmadapter->upld_len, &mbuf, rx_len,
|
|
pmadapter->pcard_sd->ioport + port)) {
|
|
PRINTM(MERROR, "Recovery: Fail to do cmd53\n");
|
|
}
|
|
if (pkt_type != MLAN_TYPE_DATA && pkt_type != MLAN_TYPE_SPA_DATA) {
|
|
PRINTM(MERROR,
|
|
"Recovery: Receive a wrong pkt: type=%d, len=%d\n",
|
|
pkt_type, pmadapter->upld_len);
|
|
goto done;
|
|
}
|
|
if (pkt_type == MLAN_TYPE_DATA) {
|
|
// TODO fill the hole in Rx reorder table
|
|
PRINTM(MDATA, "Recovery: Drop Data packet\n");
|
|
pmadapter->dbg.num_pkt_dropped++;
|
|
} else if (pkt_type == MLAN_TYPE_SPA_DATA) {
|
|
PRINTM(MDATA, "Recovery: SPA Data packet len=%d\n",
|
|
pmadapter->upld_len);
|
|
wlan_decode_spa_buffer(pmadapter, pmadapter->pcard_sd->rx_buf,
|
|
pmadapter->upld_len);
|
|
pmadapter->data_received = MTRUE;
|
|
}
|
|
PRINTM(MMSG, "wlan: Success handle rx port=%d, rx_len=%d \n", port,
|
|
rx_len);
|
|
ret = MLAN_STATUS_SUCCESS;
|
|
done:
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function checks the interrupt status and handle it accordingly.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_process_sdio_int_status(mlan_adapter *pmadapter)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
t_u8 sdio_ireg;
|
|
mlan_buffer *pmbuf = MNULL;
|
|
|
|
t_u8 port = 0;
|
|
t_u32 len_reg_l, len_reg_u;
|
|
t_u32 rx_blocks;
|
|
t_u8 bit_count = 0;
|
|
t_u32 ps_state = pmadapter->ps_state;
|
|
t_u16 rx_len;
|
|
t_u32 upld_typ = 0;
|
|
t_u32 cr = 0;
|
|
const mlan_sdio_card_reg *reg = pmadapter->pcard_sd->reg;
|
|
t_u8 rd_len_p0_l = reg->rd_len_p0_l;
|
|
t_u8 rd_len_p0_u = reg->rd_len_p0_u;
|
|
t_u8 cmd_rd_len_0 = reg->cmd_rd_len_0;
|
|
t_u8 cmd_rd_len_1 = reg->cmd_rd_len_1;
|
|
t_bool new_mode = pmadapter->pcard_sd->supports_sdio_new_mode;
|
|
|
|
ENTER();
|
|
|
|
pcb->moal_spin_lock(pmadapter->pmoal_handle, pmadapter->pint_lock);
|
|
sdio_ireg = (t_u8)pmadapter->ireg;
|
|
pmadapter->ireg = 0;
|
|
pcb->moal_spin_unlock(pmadapter->pmoal_handle, pmadapter->pint_lock);
|
|
|
|
if (!sdio_ireg)
|
|
goto done;
|
|
|
|
if (new_mode) {
|
|
/* check the command port */
|
|
if (sdio_ireg & DN_LD_CMD_PORT_HOST_INT_STATUS) {
|
|
if (pmadapter->cmd_sent)
|
|
pmadapter->cmd_sent = MFALSE;
|
|
|
|
PRINTM(MINFO, "cmd_sent=%d\n", pmadapter->cmd_sent);
|
|
}
|
|
|
|
if (sdio_ireg & UP_LD_CMD_PORT_HOST_INT_STATUS) {
|
|
/* read the len of control packet */
|
|
rx_len = ((t_u16)pmadapter->pcard_sd
|
|
->mp_regs[cmd_rd_len_1])
|
|
<< 8;
|
|
rx_len |= (t_u16)pmadapter->pcard_sd
|
|
->mp_regs[cmd_rd_len_0];
|
|
PRINTM(MINFO, "RX: cmd port rx_len=%u\n", rx_len);
|
|
rx_blocks = (rx_len + MLAN_SDIO_BLOCK_SIZE - 1) /
|
|
MLAN_SDIO_BLOCK_SIZE;
|
|
if (rx_len <= SDIO_INTF_HEADER_LEN ||
|
|
(rx_blocks * MLAN_SDIO_BLOCK_SIZE) >
|
|
ALLOC_BUF_SIZE) {
|
|
PRINTM(MERROR, "invalid rx_len=%d\n", rx_len);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
rx_len = (t_u16)(rx_blocks * MLAN_SDIO_BLOCK_SIZE);
|
|
pmbuf = wlan_alloc_mlan_buffer(pmadapter, rx_len, 0,
|
|
MOAL_MALLOC_BUFFER);
|
|
if (pmbuf == MNULL) {
|
|
PRINTM(MERROR,
|
|
"Failed to allocate 'mlan_buffer'\n");
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
PRINTM(MINFO, "cmd rx buffer rx_len = %d\n", rx_len);
|
|
|
|
/* Transfer data from card */
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
wlan_sdio_card_to_host(pmadapter, &upld_typ,
|
|
(t_u32 *)&pmadapter->upld_len,
|
|
pmbuf, rx_len,
|
|
pmadapter->pcard_sd->ioport |
|
|
CMD_PORT_SLCT)) {
|
|
pmadapter->dbg.num_cmdevt_card_to_host_failure++;
|
|
PRINTM(MERROR,
|
|
"Card-to-host cmd failed: int status=0x%x\n",
|
|
sdio_ireg);
|
|
wlan_free_mlan_buffer(pmadapter, pmbuf);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto term_cmd53;
|
|
}
|
|
|
|
if ((upld_typ != MLAN_TYPE_CMD) &&
|
|
(upld_typ != MLAN_TYPE_EVENT))
|
|
PRINTM(MERROR,
|
|
"receive a wrong packet from CMD PORT. type =0x%x\n",
|
|
upld_typ);
|
|
|
|
wlan_decode_rx_packet(pmadapter, pmbuf, upld_typ,
|
|
MFALSE);
|
|
|
|
/* We might receive data/sleep_cfm at the same time */
|
|
/* reset data_receive flag to avoid ps_state change */
|
|
if ((ps_state == PS_STATE_SLEEP_CFM) &&
|
|
(pmadapter->ps_state == PS_STATE_SLEEP))
|
|
pmadapter->data_received = MFALSE;
|
|
}
|
|
}
|
|
|
|
if (sdio_ireg & DN_LD_HOST_INT_STATUS) {
|
|
if (pmadapter->pcard_sd->mp_wr_bitmap &
|
|
pmadapter->pcard_sd->mp_data_port_mask)
|
|
pmadapter->pcard_sd->mp_invalid_update++;
|
|
pmadapter->pcard_sd->mp_wr_bitmap =
|
|
(t_u32)pmadapter->pcard_sd->mp_regs[reg->wr_bitmap_l];
|
|
pmadapter->pcard_sd->mp_wr_bitmap |=
|
|
((t_u32)pmadapter->pcard_sd->mp_regs[reg->wr_bitmap_u])
|
|
<< 8;
|
|
if (new_mode) {
|
|
pmadapter->pcard_sd->mp_wr_bitmap |=
|
|
((t_u32)pmadapter->pcard_sd
|
|
->mp_regs[reg->wr_bitmap_1l])
|
|
<< 16;
|
|
pmadapter->pcard_sd->mp_wr_bitmap |=
|
|
((t_u32)pmadapter->pcard_sd
|
|
->mp_regs[reg->wr_bitmap_1u])
|
|
<< 24;
|
|
}
|
|
bit_count = bitcount(pmadapter->pcard_sd->mp_wr_bitmap &
|
|
pmadapter->pcard_sd->mp_data_port_mask);
|
|
if (bit_count) {
|
|
pmadapter->pcard_sd->mp_update[bit_count - 1]++;
|
|
if (pmadapter->pcard_sd->mp_update[bit_count - 1] ==
|
|
0xffffffff)
|
|
memset(pmadapter,
|
|
pmadapter->pcard_sd->mp_update, 0,
|
|
sizeof(pmadapter->pcard_sd->mp_update));
|
|
}
|
|
|
|
pmadapter->pcard_sd->last_recv_wr_bitmap =
|
|
pmadapter->pcard_sd->mp_wr_bitmap;
|
|
PRINTM(MINTR, "DNLD: wr_bitmap=0x%08x\n",
|
|
pmadapter->pcard_sd->mp_wr_bitmap);
|
|
if (pmadapter->data_sent &&
|
|
(pmadapter->pcard_sd->mp_wr_bitmap &
|
|
(1 << pmadapter->pcard_sd->curr_wr_port))) {
|
|
pmadapter->callbacks.moal_tp_accounting_rx_param(
|
|
pmadapter->pmoal_handle, 3, 0);
|
|
PRINTM(MINFO, " <--- Tx DONE Interrupt --->\n");
|
|
pmadapter->data_sent = MFALSE;
|
|
}
|
|
}
|
|
if ((!new_mode) && (pmadapter->cmd_sent == MTRUE)) {
|
|
/* Check if firmware has attach buffer at command port and
|
|
* update just that in wr_bit_map. */
|
|
pmadapter->pcard_sd->mp_wr_bitmap |=
|
|
(t_u32)pmadapter->pcard_sd->mp_regs[reg->wr_bitmap_l] &
|
|
CTRL_PORT_MASK;
|
|
if (pmadapter->pcard_sd->mp_wr_bitmap & CTRL_PORT_MASK)
|
|
pmadapter->cmd_sent = MFALSE;
|
|
}
|
|
|
|
if (sdio_ireg & UP_LD_HOST_INT_STATUS) {
|
|
pmadapter->pcard_sd->mp_rd_bitmap =
|
|
(t_u32)pmadapter->pcard_sd->mp_regs[reg->rd_bitmap_l];
|
|
pmadapter->pcard_sd->mp_rd_bitmap |=
|
|
((t_u32)pmadapter->pcard_sd->mp_regs[reg->rd_bitmap_u])
|
|
<< 8;
|
|
if (new_mode) {
|
|
pmadapter->pcard_sd->mp_rd_bitmap |=
|
|
((t_u32)pmadapter->pcard_sd
|
|
->mp_regs[reg->rd_bitmap_1l])
|
|
<< 16;
|
|
pmadapter->pcard_sd->mp_rd_bitmap |=
|
|
((t_u32)pmadapter->pcard_sd
|
|
->mp_regs[reg->rd_bitmap_1u])
|
|
<< 24;
|
|
}
|
|
pmadapter->pcard_sd->last_recv_rd_bitmap =
|
|
pmadapter->pcard_sd->mp_rd_bitmap;
|
|
|
|
PRINTM(MINTR, "UPLD: rd_bitmap=0x%08x\n",
|
|
pmadapter->pcard_sd->mp_rd_bitmap);
|
|
pmadapter->callbacks.moal_tp_accounting_rx_param(
|
|
pmadapter->pmoal_handle, 0, 0);
|
|
|
|
while (MTRUE) {
|
|
ret = wlan_get_rd_port(pmadapter, &port);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MINFO,
|
|
"no more rd_port to be handled\n");
|
|
break;
|
|
}
|
|
len_reg_l = rd_len_p0_l + (port << 1);
|
|
len_reg_u = rd_len_p0_u + (port << 1);
|
|
rx_len =
|
|
((t_u16)pmadapter->pcard_sd->mp_regs[len_reg_u])
|
|
<< 8;
|
|
rx_len |=
|
|
(t_u16)pmadapter->pcard_sd->mp_regs[len_reg_l];
|
|
PRINTM(MINFO, "RX: port=%d rx_len=%u\n", port, rx_len);
|
|
rx_blocks = (rx_len + MLAN_SDIO_BLOCK_SIZE - 1) /
|
|
MLAN_SDIO_BLOCK_SIZE;
|
|
if (rx_len <= SDIO_INTF_HEADER_LEN ||
|
|
(rx_blocks * MLAN_SDIO_BLOCK_SIZE) >
|
|
pmadapter->pcard_sd->mpa_rx.buf_size) {
|
|
PRINTM(MERROR, "invalid rx_len=%d\n", rx_len);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
rx_len = (t_u16)(rx_blocks * MLAN_SDIO_BLOCK_SIZE);
|
|
|
|
if (!new_mode && (port == CTRL_PORT))
|
|
pmbuf = wlan_alloc_mlan_buffer(
|
|
pmadapter, rx_len, 0,
|
|
MOAL_MALLOC_BUFFER);
|
|
else
|
|
pmbuf = wlan_alloc_mlan_buffer(
|
|
pmadapter, rx_len, MLAN_RX_HEADER_LEN,
|
|
MOAL_ALLOC_MLAN_BUFFER);
|
|
if (pmbuf == MNULL) {
|
|
PRINTM(MERROR,
|
|
"Failed to allocate 'mlan_buffer'\n");
|
|
pmadapter->dbg.num_alloc_buffer_failure++;
|
|
if (MLAN_STATUS_SUCCESS ==
|
|
wlan_sdio_card_to_host_recovery(
|
|
pmadapter, port, rx_len))
|
|
continue;
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
PRINTM(MINFO, "rx_len = %d\n", rx_len);
|
|
if (MLAN_STATUS_SUCCESS !=
|
|
wlan_sdio_card_to_host_mp_aggr(pmadapter, pmbuf,
|
|
port, rx_len)) {
|
|
if ((!new_mode) && (port == CTRL_PORT))
|
|
pmadapter->dbg
|
|
.num_cmdevt_card_to_host_failure++;
|
|
else
|
|
pmadapter->dbg
|
|
.num_rx_card_to_host_failure++;
|
|
|
|
PRINTM(MERROR,
|
|
"Card to host failed: int status=0x%x\n",
|
|
sdio_ireg);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto term_cmd53;
|
|
}
|
|
}
|
|
/* We might receive data/sleep_cfm at the same time */
|
|
/* reset data_receive flag to avoid ps_state change */
|
|
if ((ps_state == PS_STATE_SLEEP_CFM) &&
|
|
(pmadapter->ps_state == PS_STATE_SLEEP))
|
|
pmadapter->data_received = MFALSE;
|
|
}
|
|
|
|
ret = MLAN_STATUS_SUCCESS;
|
|
goto done;
|
|
|
|
term_cmd53:
|
|
/* terminate cmd53 */
|
|
if (MLAN_STATUS_SUCCESS != pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
HOST_TO_CARD_EVENT_REG,
|
|
&cr))
|
|
PRINTM(MERROR, "read CFG reg failed\n");
|
|
PRINTM(MINFO, "Config Reg val = %d\n", cr);
|
|
if (MLAN_STATUS_SUCCESS != pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
HOST_TO_CARD_EVENT_REG,
|
|
(cr | HOST_TERM_CMD53)))
|
|
PRINTM(MERROR, "write CFG reg failed\n");
|
|
PRINTM(MINFO, "write success\n");
|
|
if (MLAN_STATUS_SUCCESS != pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
HOST_TO_CARD_EVENT_REG,
|
|
&cr))
|
|
PRINTM(MERROR, "read CFG reg failed\n");
|
|
PRINTM(MINFO, "Config reg val =%x\n", cr);
|
|
|
|
done:
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function sends data to the card.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param type data or command
|
|
* @param pmbuf A pointer to mlan_buffer (pmbuf->data_len should include
|
|
* SDIO header)
|
|
* @param tx_param A pointer to mlan_tx_param
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
mlan_status wlan_sdio_host_to_card(mlan_adapter *pmadapter, t_u8 type,
|
|
mlan_buffer *pmbuf, mlan_tx_param *tx_param)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
t_u32 buf_block_len;
|
|
t_u32 blksz;
|
|
t_u8 port = 0;
|
|
t_u32 cmd53_port = 0;
|
|
t_u8 *payload = pmbuf->pbuf + pmbuf->data_offset;
|
|
t_bool new_mode = pmadapter->pcard_sd->supports_sdio_new_mode;
|
|
|
|
ENTER();
|
|
|
|
/* Allocate buffer and copy payload */
|
|
blksz = MLAN_SDIO_BLOCK_SIZE;
|
|
buf_block_len = (pmbuf->data_len + blksz - 1) / blksz;
|
|
*(t_u16 *)&payload[0] = wlan_cpu_to_le16((t_u16)pmbuf->data_len);
|
|
*(t_u16 *)&payload[2] = wlan_cpu_to_le16(type);
|
|
|
|
/*
|
|
* This is SDIO specific header
|
|
* t_u16 length,
|
|
* t_u16 type (MLAN_TYPE_DATA = 0,
|
|
* MLAN_TYPE_CMD = 1, MLAN_TYPE_EVENT = 3)
|
|
*/
|
|
if (type == MLAN_TYPE_DATA) {
|
|
ret = wlan_get_wr_port_data(pmadapter, &port);
|
|
if (ret != MLAN_STATUS_SUCCESS) {
|
|
PRINTM(MERROR,
|
|
"no wr_port available: wr_bitmap=0x%08x curr_wr_port=%d\n",
|
|
pmadapter->pcard_sd->mp_wr_bitmap,
|
|
pmadapter->pcard_sd->curr_wr_port);
|
|
goto exit;
|
|
}
|
|
/* Transfer data to card */
|
|
pmbuf->data_len = buf_block_len * blksz;
|
|
|
|
if (tx_param)
|
|
ret = wlan_host_to_card_mp_aggr(pmadapter, pmbuf, port,
|
|
tx_param->next_pkt_len);
|
|
else
|
|
ret = wlan_host_to_card_mp_aggr(pmadapter, pmbuf, port,
|
|
0);
|
|
} else {
|
|
/*Type must be MLAN_TYPE_CMD*/
|
|
pmadapter->cmd_sent = MTRUE;
|
|
if (!new_mode)
|
|
pmadapter->pcard_sd->mp_wr_bitmap &=
|
|
(t_u32)(~(1 << CTRL_PORT));
|
|
if (pmbuf->data_len <= SDIO_INTF_HEADER_LEN ||
|
|
pmbuf->data_len > WLAN_UPLD_SIZE)
|
|
PRINTM(MWARN,
|
|
"wlan_sdio_host_to_card(): Error: payload=%p, nb=%d\n",
|
|
payload, pmbuf->data_len);
|
|
/* Transfer data to card */
|
|
pmbuf->data_len = buf_block_len * blksz;
|
|
if (new_mode)
|
|
cmd53_port =
|
|
(pmadapter->pcard_sd->ioport) | CMD_PORT_SLCT;
|
|
else
|
|
cmd53_port = pmadapter->pcard_sd->ioport + CTRL_PORT;
|
|
ret = wlan_write_data_sync(pmadapter, pmbuf, cmd53_port);
|
|
}
|
|
|
|
if (ret == MLAN_STATUS_FAILURE) {
|
|
PRINTM(MERROR, "Error: host_to_card failed: 0x%X\n", ret);
|
|
if (type == MLAN_TYPE_CMD)
|
|
pmadapter->cmd_sent = MFALSE;
|
|
if (type == MLAN_TYPE_DATA)
|
|
pmadapter->data_sent = MFALSE;
|
|
} else {
|
|
if (type == MLAN_TYPE_DATA) {
|
|
if (!(pmadapter->pcard_sd->mp_wr_bitmap &
|
|
(1 << pmadapter->pcard_sd->curr_wr_port)))
|
|
pmadapter->data_sent = MTRUE;
|
|
else
|
|
pmadapter->data_sent = MFALSE;
|
|
}
|
|
DBG_HEXDUMP(MIF_D, "SDIO Blk Wr",
|
|
pmbuf->pbuf + pmbuf->data_offset,
|
|
MIN(pmbuf->data_len, MAX_DATA_DUMP_LEN));
|
|
}
|
|
exit:
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
#if (defined(SD9098) || defined(SD9097) || defined(SDNW62X) || defined(SD9177))
|
|
/**
|
|
* @brief This function sends vdll data to the card.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param pmbuf A pointer to mlan_buffer (pmbuf->data_len should include
|
|
* SDIO header)
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_send_vdll(mlan_adapter *pmadapter,
|
|
mlan_buffer *pmbuf)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
t_u32 buf_block_len;
|
|
t_u32 blksz;
|
|
t_u8 *payload = pmbuf->pbuf + pmbuf->data_offset;
|
|
t_u32 cmd53_port = 0;
|
|
ENTER();
|
|
blksz = MLAN_SDIO_BLOCK_SIZE;
|
|
buf_block_len = (pmbuf->data_len + blksz - 1) / blksz;
|
|
|
|
*(t_u16 *)&payload[0] = wlan_cpu_to_le16((t_u16)pmbuf->data_len);
|
|
*(t_u16 *)&payload[2] = wlan_cpu_to_le16(MLAN_TYPE_VDLL);
|
|
|
|
pmbuf->data_len = buf_block_len * blksz;
|
|
|
|
if (pmbuf->data_len > MRVDRV_SIZE_OF_CMD_BUFFER) {
|
|
PRINTM(MERROR, "VDLL block is too big: %d\n", pmbuf->data_len);
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
cmd53_port = (pmadapter->pcard_sd->ioport) | CMD_PORT_SLCT;
|
|
pmadapter->cmd_sent = MTRUE;
|
|
ret = wlan_write_data_sync(pmadapter, pmbuf, cmd53_port);
|
|
if (ret == MLAN_STATUS_FAILURE)
|
|
PRINTM(MERROR, "Send Vdll: host_to_card failed: 0x%X\n", ret);
|
|
else
|
|
DBG_HEXDUMP(MIF_D, "SDIO Blk Wr",
|
|
pmbuf->pbuf + pmbuf->data_offset,
|
|
MIN(pmbuf->data_len, MAX_DATA_DUMP_LEN));
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
#endif
|
|
|
|
/**
|
|
* @brief This function sends data to the card.
|
|
*
|
|
* @param pmpriv A pointer to mlan_private structure
|
|
* @param type data or command
|
|
* @param pmbuf A pointer to mlan_buffer (pmbuf->data_len should include
|
|
* SDIO header)
|
|
* @param tx_param A pointer to mlan_tx_param
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_sdio_host_to_card_ext(pmlan_private pmpriv, t_u8 type,
|
|
mlan_buffer *pmbuf,
|
|
mlan_tx_param *tx_param)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
mlan_adapter *pmadapter = pmpriv->adapter;
|
|
|
|
#if (defined(SD9098) || defined(SD9097) || defined(SDNW62X) || defined(SD9177))
|
|
if (type == MLAN_TYPE_VDLL)
|
|
return wlan_sdio_send_vdll(pmadapter, pmbuf);
|
|
#endif
|
|
ret = wlan_sdio_host_to_card(pmadapter, type, pmbuf, tx_param);
|
|
|
|
if (type == MLAN_TYPE_DATA && ret == MLAN_STATUS_FAILURE)
|
|
pmadapter->data_sent = MFALSE;
|
|
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief Deaggregate single port aggregation packet
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param buf A pointer to aggregated data packet
|
|
* @param len
|
|
*
|
|
* @return N/A
|
|
*/
|
|
void wlan_decode_spa_buffer(mlan_adapter *pmadapter, t_u8 *buf, t_u32 len)
|
|
{
|
|
int total_pkt_len;
|
|
t_u8 block_num = 0;
|
|
t_u16 block_size = 0;
|
|
t_u8 *data;
|
|
t_u32 pkt_len;
|
|
mlan_buffer *mbuf_deaggr = MNULL;
|
|
|
|
ENTER();
|
|
|
|
data = (t_u8 *)buf;
|
|
total_pkt_len = len;
|
|
if (total_pkt_len < pmadapter->pcard_sd->sdio_rx_block_size) {
|
|
PRINTM(MERROR, "Invalid sp aggr packet size=%d\n",
|
|
total_pkt_len);
|
|
goto done;
|
|
}
|
|
while (total_pkt_len >=
|
|
(OFFSET_OF_SDIO_HEADER + SDIO_INTF_HEADER_LEN)) {
|
|
block_num = *(data + OFFSET_OF_BLOCK_NUMBER);
|
|
block_size =
|
|
pmadapter->pcard_sd->sdio_rx_block_size * block_num;
|
|
if (block_size > total_pkt_len) {
|
|
PRINTM(MERROR,
|
|
"Error in pkt, block_num=%d, pkt_len=%d\n",
|
|
block_num, total_pkt_len);
|
|
break;
|
|
}
|
|
pkt_len = wlan_le16_to_cpu(
|
|
*(t_u16 *)(data + OFFSET_OF_SDIO_HEADER));
|
|
if ((pkt_len + OFFSET_OF_SDIO_HEADER) > block_size) {
|
|
PRINTM(MERROR,
|
|
"Error in pkt, pkt_len=%d, block_size=%d\n",
|
|
pkt_len, block_size);
|
|
break;
|
|
}
|
|
mbuf_deaggr = wlan_alloc_mlan_buffer(
|
|
pmadapter, pkt_len - SDIO_INTF_HEADER_LEN,
|
|
MLAN_RX_HEADER_LEN, MOAL_ALLOC_MLAN_BUFFER);
|
|
if (mbuf_deaggr == MNULL) {
|
|
PRINTM(MERROR, "Error allocating daggr mlan_buffer\n");
|
|
break;
|
|
}
|
|
memcpy_ext(pmadapter,
|
|
mbuf_deaggr->pbuf + mbuf_deaggr->data_offset,
|
|
data + OFFSET_OF_SDIO_HEADER + SDIO_INTF_HEADER_LEN,
|
|
pkt_len - SDIO_INTF_HEADER_LEN,
|
|
pkt_len - SDIO_INTF_HEADER_LEN);
|
|
mbuf_deaggr->data_len = pkt_len - SDIO_INTF_HEADER_LEN;
|
|
wlan_handle_rx_packet(pmadapter, mbuf_deaggr);
|
|
data += block_size;
|
|
total_pkt_len -= block_size;
|
|
if (total_pkt_len < pmadapter->pcard_sd->sdio_rx_block_size)
|
|
break;
|
|
}
|
|
done:
|
|
LEAVE();
|
|
return;
|
|
}
|
|
|
|
/**
|
|
* @brief This function deaggr rx pkt
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param pmbuf A pointer to the SDIO mpa data
|
|
* @return N/A
|
|
*/
|
|
t_void wlan_sdio_deaggr_rx_pkt(pmlan_adapter pmadapter, mlan_buffer *pmbuf)
|
|
{
|
|
if (pmbuf->buf_type == MLAN_BUF_TYPE_SPA_DATA) {
|
|
wlan_decode_spa_buffer(pmadapter,
|
|
pmbuf->pbuf + pmbuf->data_offset,
|
|
pmbuf->data_len);
|
|
wlan_free_mlan_buffer(pmadapter, pmbuf);
|
|
} else
|
|
wlan_handle_rx_packet(pmadapter, pmbuf);
|
|
}
|
|
|
|
/**
|
|
* @brief This function allocates buffer for the SDIO aggregation buffer
|
|
* related members of adapter structure
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param mpa_tx_buf_size Tx buffer size to allocate
|
|
* @param mpa_rx_buf_size Rx buffer size to allocate
|
|
*
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
mlan_status wlan_alloc_sdio_mpa_buffers(mlan_adapter *pmadapter,
|
|
t_u32 mpa_tx_buf_size,
|
|
t_u32 mpa_rx_buf_size)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
t_u8 mp_aggr_pkt_limit = pmadapter->pcard_sd->mp_aggr_pkt_limit;
|
|
|
|
ENTER();
|
|
|
|
if ((pmadapter->pcard_sd->max_segs < mp_aggr_pkt_limit) ||
|
|
(pmadapter->pcard_sd->max_seg_size <
|
|
pmadapter->pcard_sd->max_sp_tx_size)) {
|
|
ret = pcb->moal_malloc(
|
|
pmadapter->pmoal_handle,
|
|
mpa_tx_buf_size + DMA_ALIGNMENT,
|
|
MLAN_MEM_DEF | MLAN_MEM_DMA,
|
|
(t_u8 **)&pmadapter->pcard_sd->mpa_tx.head_ptr);
|
|
if (ret != MLAN_STATUS_SUCCESS ||
|
|
!pmadapter->pcard_sd->mpa_tx.head_ptr) {
|
|
PRINTM(MERROR,
|
|
"Could not allocate buffer for SDIO MP TX aggr\n");
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto error;
|
|
}
|
|
pmadapter->pcard_sd->mpa_tx.buf = (t_u8 *)ALIGN_ADDR(
|
|
pmadapter->pcard_sd->mpa_tx.head_ptr, DMA_ALIGNMENT);
|
|
} else {
|
|
PRINTM(MMSG, "wlan: Enable TX SG mode\n");
|
|
pmadapter->pcard_sd->mpa_tx.head_ptr = MNULL;
|
|
pmadapter->pcard_sd->mpa_tx.buf = MNULL;
|
|
}
|
|
pmadapter->pcard_sd->mpa_tx.buf_size = mpa_tx_buf_size;
|
|
|
|
if ((pmadapter->pcard_sd->max_segs < mp_aggr_pkt_limit) ||
|
|
(pmadapter->pcard_sd->max_seg_size <
|
|
pmadapter->pcard_sd->max_sp_rx_size)) {
|
|
ret = pcb->moal_malloc(
|
|
pmadapter->pmoal_handle,
|
|
mpa_rx_buf_size + DMA_ALIGNMENT,
|
|
MLAN_MEM_DEF | MLAN_MEM_DMA,
|
|
(t_u8 **)&pmadapter->pcard_sd->mpa_rx.head_ptr);
|
|
if (ret != MLAN_STATUS_SUCCESS ||
|
|
!pmadapter->pcard_sd->mpa_rx.head_ptr) {
|
|
PRINTM(MERROR,
|
|
"Could not allocate buffer for SDIO MP RX aggr\n");
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto error;
|
|
}
|
|
pmadapter->pcard_sd->mpa_rx.buf = (t_u8 *)ALIGN_ADDR(
|
|
pmadapter->pcard_sd->mpa_rx.head_ptr, DMA_ALIGNMENT);
|
|
} else {
|
|
PRINTM(MMSG, "wlan: Enable RX SG mode\n");
|
|
pmadapter->pcard_sd->mpa_rx.head_ptr = MNULL;
|
|
pmadapter->pcard_sd->mpa_rx.buf = MNULL;
|
|
}
|
|
pmadapter->pcard_sd->mpa_rx.buf_size = mpa_rx_buf_size;
|
|
error:
|
|
if (ret != MLAN_STATUS_SUCCESS)
|
|
wlan_free_sdio_mpa_buffers(pmadapter);
|
|
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function frees buffers for the SDIO aggregation
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
*
|
|
* @return MLAN_STATUS_SUCCESS
|
|
*/
|
|
mlan_status wlan_free_sdio_mpa_buffers(mlan_adapter *pmadapter)
|
|
{
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
|
|
ENTER();
|
|
|
|
if (pmadapter->pcard_sd->mpa_tx.buf) {
|
|
pcb->moal_mfree(pmadapter->pmoal_handle,
|
|
(t_u8 *)pmadapter->pcard_sd->mpa_tx.head_ptr);
|
|
pmadapter->pcard_sd->mpa_tx.head_ptr = MNULL;
|
|
pmadapter->pcard_sd->mpa_tx.buf = MNULL;
|
|
pmadapter->pcard_sd->mpa_tx.buf_size = 0;
|
|
}
|
|
|
|
if (pmadapter->pcard_sd->mpa_rx.buf) {
|
|
pcb->moal_mfree(pmadapter->pmoal_handle,
|
|
(t_u8 *)pmadapter->pcard_sd->mpa_rx.head_ptr);
|
|
pmadapter->pcard_sd->mpa_rx.head_ptr = MNULL;
|
|
pmadapter->pcard_sd->mpa_rx.buf = MNULL;
|
|
pmadapter->pcard_sd->mpa_rx.buf_size = 0;
|
|
}
|
|
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief This function re-allocate rx mpa buffer
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
*
|
|
* @return MLAN_STATUS_SUCCESS
|
|
*/
|
|
mlan_status wlan_re_alloc_sdio_rx_mpa_buffer(mlan_adapter *pmadapter)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
t_u8 mp_aggr_pkt_limit = pmadapter->pcard_sd->mp_aggr_pkt_limit;
|
|
t_u32 mpa_rx_buf_size = pmadapter->pcard_sd->mp_tx_aggr_buf_size;
|
|
|
|
if (pmadapter->pcard_sd->mpa_rx.buf) {
|
|
pcb->moal_mfree(pmadapter->pmoal_handle,
|
|
(t_u8 *)pmadapter->pcard_sd->mpa_rx.head_ptr);
|
|
pmadapter->pcard_sd->mpa_rx.head_ptr = MNULL;
|
|
pmadapter->pcard_sd->mpa_rx.buf = MNULL;
|
|
pmadapter->pcard_sd->mpa_rx.buf_size = 0;
|
|
}
|
|
if (pmadapter->pcard_sd->sdio_rx_aggr_enable) {
|
|
mpa_rx_buf_size = MAX(mpa_rx_buf_size, SDIO_CMD53_MAX_SIZE);
|
|
/** reallocate rx buffer for recover when single port rx
|
|
* aggregation enabled */
|
|
if (pmadapter->pcard_sd->rx_buffer) {
|
|
pcb->moal_mfree(pmadapter->pmoal_handle,
|
|
(t_u8 *)pmadapter->pcard_sd->rx_buffer);
|
|
pmadapter->pcard_sd->rx_buffer = MNULL;
|
|
pmadapter->pcard_sd->rx_buf = MNULL;
|
|
}
|
|
ret = pmadapter->callbacks.moal_malloc(
|
|
pmadapter->pmoal_handle,
|
|
SDIO_CMD53_MAX_SIZE + DMA_ALIGNMENT,
|
|
MLAN_MEM_DEF | MLAN_MEM_DMA,
|
|
(t_u8 **)&pmadapter->pcard_sd->rx_buffer);
|
|
|
|
if (ret != MLAN_STATUS_SUCCESS ||
|
|
!pmadapter->pcard_sd->rx_buffer) {
|
|
PRINTM(MERROR, "Failed to allocate receive buffer\n");
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto error;
|
|
}
|
|
pmadapter->pcard_sd->rx_buf = (t_u8 *)ALIGN_ADDR(
|
|
pmadapter->pcard_sd->rx_buffer, DMA_ALIGNMENT);
|
|
}
|
|
if ((pmadapter->pcard_sd->max_segs < mp_aggr_pkt_limit) ||
|
|
(pmadapter->pcard_sd->max_seg_size <
|
|
pmadapter->pcard_sd->max_sp_rx_size)) {
|
|
ret = pcb->moal_malloc(
|
|
pmadapter->pmoal_handle,
|
|
mpa_rx_buf_size + DMA_ALIGNMENT,
|
|
MLAN_MEM_DEF | MLAN_MEM_DMA,
|
|
(t_u8 **)&pmadapter->pcard_sd->mpa_rx.head_ptr);
|
|
if (ret != MLAN_STATUS_SUCCESS ||
|
|
!pmadapter->pcard_sd->mpa_rx.head_ptr) {
|
|
PRINTM(MERROR,
|
|
"Could not allocate buffer for SDIO MP RX aggr\n");
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto error;
|
|
}
|
|
pmadapter->pcard_sd->mpa_rx.buf = (t_u8 *)ALIGN_ADDR(
|
|
pmadapter->pcard_sd->mpa_rx.head_ptr, DMA_ALIGNMENT);
|
|
} else {
|
|
PRINTM(MMSG, "wlan: Enable RX SG mode\n");
|
|
pmadapter->pcard_sd->mpa_rx.head_ptr = MNULL;
|
|
pmadapter->pcard_sd->mpa_rx.buf = MNULL;
|
|
}
|
|
pmadapter->pcard_sd->mpa_rx.buf_size = mpa_rx_buf_size;
|
|
PRINTM(MMSG, "mpa_rx_buf_size=%d\n", mpa_rx_buf_size);
|
|
error:
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function wakes up the card.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param timeout set timeout flag
|
|
*
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_pm_sdio_wakeup_card(pmlan_adapter pmadapter,
|
|
t_u8 timeout)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
t_u32 age_ts_usec;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
|
|
ENTER();
|
|
PRINTM(MEVENT, "Wakeup device...\n");
|
|
pmadapter->callbacks.moal_get_system_time(pmadapter->pmoal_handle,
|
|
&pmadapter->pm_wakeup_in_secs,
|
|
&age_ts_usec);
|
|
|
|
if (timeout) {
|
|
pmadapter->callbacks.moal_start_timer(
|
|
pmadapter->pmoal_handle, pmadapter->pwakeup_fw_timer,
|
|
MFALSE, MRVDRV_TIMER_3S);
|
|
pmadapter->wakeup_fw_timer_is_set = MTRUE;
|
|
}
|
|
|
|
ret = pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
HOST_TO_CARD_EVENT_REG, HOST_POWER_UP);
|
|
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function resets the PM setting of the card.
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
*
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
static mlan_status wlan_pm_sdio_reset_card(pmlan_adapter pmadapter)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
|
|
ENTER();
|
|
|
|
ret = pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
HOST_TO_CARD_EVENT_REG, 0);
|
|
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function issues commands to initialize firmware
|
|
*
|
|
* @param priv A pointer to mlan_private structure
|
|
*
|
|
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
|
|
*/
|
|
mlan_status wlan_set_sdio_gpio_int(pmlan_private priv)
|
|
{
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
pmlan_adapter pmadapter = MNULL;
|
|
HostCmd_DS_SDIO_GPIO_INT_CONFIG sdio_int_cfg;
|
|
|
|
if (!priv) {
|
|
LEAVE();
|
|
return MLAN_STATUS_FAILURE;
|
|
}
|
|
pmadapter = priv->adapter;
|
|
|
|
ENTER();
|
|
|
|
if (pmadapter->pcard_sd->int_mode == INT_MODE_GPIO) {
|
|
if (pmadapter->pcard_sd->gpio_pin != GPIO_INT_NEW_MODE) {
|
|
PRINTM(MINFO,
|
|
"SDIO_GPIO_INT_CONFIG: interrupt mode is GPIO\n");
|
|
sdio_int_cfg.action = HostCmd_ACT_GEN_SET;
|
|
sdio_int_cfg.gpio_pin = pmadapter->pcard_sd->gpio_pin;
|
|
sdio_int_cfg.gpio_int_edge = INT_FALLING_EDGE;
|
|
sdio_int_cfg.gpio_pulse_width = DELAY_1_US;
|
|
ret = wlan_prepare_cmd(priv,
|
|
HostCmd_CMD_SDIO_GPIO_INT_CONFIG,
|
|
HostCmd_ACT_GEN_SET, 0, MNULL,
|
|
&sdio_int_cfg);
|
|
|
|
if (ret) {
|
|
PRINTM(MERROR,
|
|
"SDIO_GPIO_INT_CONFIG: send command fail\n");
|
|
ret = MLAN_STATUS_FAILURE;
|
|
}
|
|
}
|
|
} else {
|
|
PRINTM(MINFO, "SDIO_GPIO_INT_CONFIG: interrupt mode is SDIO\n");
|
|
}
|
|
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function prepares command of SDIO GPIO interrupt
|
|
*
|
|
* @param pmpriv A pointer to mlan_private structure
|
|
* @param cmd A pointer to HostCmd_DS_COMMAND structure
|
|
* @param cmd_action The action: GET or SET
|
|
* @param pdata_buf A pointer to data buffer
|
|
* @return MLAN_STATUS_SUCCESS
|
|
*/
|
|
mlan_status wlan_cmd_sdio_gpio_int(pmlan_private pmpriv,
|
|
HostCmd_DS_COMMAND *cmd, t_u16 cmd_action,
|
|
t_void *pdata_buf)
|
|
{
|
|
HostCmd_DS_SDIO_GPIO_INT_CONFIG *psdio_gpio_int =
|
|
&cmd->params.sdio_gpio_int;
|
|
|
|
ENTER();
|
|
|
|
cmd->command = wlan_cpu_to_le16(HostCmd_CMD_SDIO_GPIO_INT_CONFIG);
|
|
cmd->size = wlan_cpu_to_le16((sizeof(HostCmd_DS_SDIO_GPIO_INT_CONFIG)) +
|
|
S_DS_GEN);
|
|
|
|
memset(pmpriv->adapter, psdio_gpio_int, 0,
|
|
sizeof(HostCmd_DS_SDIO_GPIO_INT_CONFIG));
|
|
if (cmd_action == HostCmd_ACT_GEN_SET) {
|
|
memcpy_ext(pmpriv->adapter, psdio_gpio_int, pdata_buf,
|
|
sizeof(HostCmd_DS_SDIO_GPIO_INT_CONFIG),
|
|
sizeof(HostCmd_DS_SDIO_GPIO_INT_CONFIG));
|
|
psdio_gpio_int->action =
|
|
wlan_cpu_to_le16(psdio_gpio_int->action);
|
|
psdio_gpio_int->gpio_pin =
|
|
wlan_cpu_to_le16(psdio_gpio_int->gpio_pin);
|
|
psdio_gpio_int->gpio_int_edge =
|
|
wlan_cpu_to_le16(psdio_gpio_int->gpio_int_edge);
|
|
psdio_gpio_int->gpio_pulse_width =
|
|
wlan_cpu_to_le16(psdio_gpio_int->gpio_pulse_width);
|
|
}
|
|
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
mlan_status wlan_reset_fw(pmlan_adapter pmadapter)
|
|
{
|
|
t_u32 tries = 0;
|
|
t_u32 value = 1;
|
|
t_u32 reset_reg = pmadapter->pcard_sd->reg->fw_reset_reg;
|
|
t_u8 reset_val = pmadapter->pcard_sd->reg->fw_reset_val;
|
|
pmlan_callbacks pcb = &pmadapter->callbacks;
|
|
mlan_status ret = MLAN_STATUS_SUCCESS;
|
|
|
|
ENTER();
|
|
wlan_pm_sdio_wakeup_card(pmadapter, MFALSE);
|
|
|
|
/** wait SOC fully wake up */
|
|
for (tries = 0; tries < MAX_POLL_TRIES; ++tries) {
|
|
if (MLAN_STATUS_SUCCESS ==
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle, reset_reg,
|
|
0xba)) {
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle, reset_reg,
|
|
&value);
|
|
if (value == 0xba) {
|
|
PRINTM(MMSG, "FW wake up\n");
|
|
break;
|
|
}
|
|
}
|
|
pcb->moal_udelay(pmadapter->pmoal_handle, 1000);
|
|
}
|
|
/* Write register to notify FW */
|
|
if (MLAN_STATUS_FAILURE == pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
reset_reg, reset_val)) {
|
|
PRINTM(MERROR, "Failed to write register.\n");
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
#if defined(SD8997) || defined(SD8977) || defined(SD8987) || \
|
|
defined(SD9098) || defined(SD9097) || defined(SDNW62X) || \
|
|
defined(SD8978) || defined(SD9177)
|
|
if (MFALSE
|
|
#ifdef SD8997
|
|
|| IS_SD8997(pmadapter->card_type)
|
|
#endif
|
|
#ifdef SD8977
|
|
|| IS_SD8977(pmadapter->card_type)
|
|
#endif
|
|
#ifdef SD8978
|
|
|| IS_SD8978(pmadapter->card_type)
|
|
#endif
|
|
#ifdef SD8987
|
|
|| IS_SD8987(pmadapter->card_type)
|
|
#endif
|
|
#ifdef SD9098
|
|
|| IS_SD9098(pmadapter->card_type)
|
|
#endif
|
|
#ifdef SD9097
|
|
|| IS_SD9097(pmadapter->card_type)
|
|
#endif
|
|
#ifdef SDNW62X
|
|
|| IS_SDNW62X(pmadapter->card_type)
|
|
#endif
|
|
#ifdef SD9177
|
|
|| IS_SD9177(pmadapter->card_type)
|
|
#endif
|
|
) {
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle,
|
|
HOST_TO_CARD_EVENT_REG, &value);
|
|
pcb->moal_write_reg(pmadapter->pmoal_handle,
|
|
HOST_TO_CARD_EVENT_REG,
|
|
value | HOST_POWER_UP);
|
|
}
|
|
#endif
|
|
/* Poll register around 100 ms */
|
|
for (tries = 0; tries < MAX_POLL_TRIES; ++tries) {
|
|
pcb->moal_read_reg(pmadapter->pmoal_handle, reset_reg, &value);
|
|
if (value == 0)
|
|
/* FW is ready */
|
|
break;
|
|
pcb->moal_udelay(pmadapter->pmoal_handle, 1000);
|
|
}
|
|
|
|
if (value) {
|
|
PRINTM(MERROR, "Failed to poll FW reset register %X=0x%x\n",
|
|
reset_reg, value);
|
|
ret = MLAN_STATUS_FAILURE;
|
|
goto done;
|
|
}
|
|
PRINTM(MMSG, "FW Reset success\n");
|
|
ret = wlan_sdio_probe(pmadapter);
|
|
done:
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function handle event/data/cmd complete
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param pmbuf A pointer to the mlan_buffer
|
|
* @return N/A
|
|
*/
|
|
static mlan_status wlan_sdio_data_evt_complete(pmlan_adapter pmadapter,
|
|
mlan_buffer *pmbuf,
|
|
mlan_status status)
|
|
{
|
|
ENTER();
|
|
|
|
wlan_free_mlan_buffer(pmadapter, pmbuf);
|
|
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief This function handle receive packet
|
|
*
|
|
* @param pmadapter A pointer to mlan_adapter structure
|
|
* @param pmbuf A pointer to the mlan_buffer
|
|
* @return
|
|
*/
|
|
static mlan_status wlan_sdio_handle_rx_packet(mlan_adapter *pmadapter,
|
|
pmlan_buffer pmbuf)
|
|
{
|
|
ENTER();
|
|
|
|
wlan_sdio_deaggr_rx_pkt(pmadapter, pmbuf);
|
|
|
|
LEAVE();
|
|
return MLAN_STATUS_SUCCESS;
|
|
}
|
|
|
|
mlan_adapter_operations mlan_sdio_ops = {
|
|
.dnld_fw = wlan_sdio_dnld_fw,
|
|
.interrupt = wlan_sdio_interrupt,
|
|
.process_int_status = wlan_process_sdio_int_status,
|
|
.host_to_card = wlan_sdio_host_to_card_ext,
|
|
.wakeup_card = wlan_pm_sdio_wakeup_card,
|
|
.reset_card = wlan_pm_sdio_reset_card,
|
|
.event_complete = wlan_sdio_data_evt_complete,
|
|
.data_complete = wlan_sdio_data_evt_complete,
|
|
.cmdrsp_complete = wlan_sdio_data_evt_complete,
|
|
.handle_rx_packet = wlan_sdio_handle_rx_packet,
|
|
.disable_host_int = wlan_disable_sdio_host_int,
|
|
.enable_host_int = wlan_enable_sdio_host_int,
|
|
|
|
.intf_header_len = SDIO_INTF_HEADER_LEN,
|
|
};
|