RinCat/RTL88x2BU-Linux-Driver
1
0
Fork 0
mirror of https://github.com/RinCat/RTL88x2BU-Linux-Driver.git synced 2024-11-14 11:12:51 +00:00
Code Issues Packages Projects Releases Wiki Activity
86a0e96251
RTL88x2BU-Linux-Driver/hal/halmac/halmac_88xx/halmac_fw_88xx.c

1135 lines
30 KiB
C
Raw Normal View History

RTL88x2B Driver from Realtek. Version: 5.3.1
2018-11-23 20:19:44 +00:00
/******************************************************************************
*
* Copyright(c) 2016 - 2018 Realtek Corporation. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify it
* under the terms of version 2 of the GNU General Public License as
* published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful, but WITHOUT
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
* more details.
*
******************************************************************************/
#include "halmac_fw_88xx.h"
#include "halmac_88xx_cfg.h"
#include "halmac_common_88xx.h"
#include "halmac_init_88xx.h"
#if HALMAC_88XX_SUPPORT
#define DLFW_RESTORE_REG_NUM 6
#define ILLEGAL_KEY_GROUP 0xFAAAAA00
/* Max dlfw size can not over 31K, due to SDIO HW limitation */
#define DLFW_PKT_SIZE_LIMIT 31744
#define ID_INFORM_DLEMEM_RDY 0x80
#define ID_INFORM_ENETR_CPU_SLEEP 0x20
#define ID_CHECK_DLEMEM_RDY 0x80
#define ID_CHECK_ENETR_CPU_SLEEP 0x05
#define FW_STATUS_CHK_FATAL (BIT(1) | BIT(20))
#define FW_STATUS_CHK_ERR (BIT(4) | BIT(5) | BIT(6) | BIT(7) | BIT(8) | \
BIT(9) | BIT(12) | BIT(14) | BIT(15) | \
BIT(16) | BIT(17) | BIT(18) | BIT(19) | \
BIT(21) | BIT(22) | BIT(25))
#define FW_STATUS_CHK_WARN ~(FW_STATUS_CHK_FATAL | FW_STATUS_CHK_ERR)
struct halmac_backup_info {
u32 mac_register;
u32 value;
u8 length;
};
static enum halmac_ret_status
update_fw_info_88xx(struct halmac_adapter *adapter, u8 *fw_bin);
static void
restore_mac_reg_88xx(struct halmac_adapter *adapter,
struct halmac_backup_info *info, u32 num);
static enum halmac_ret_status
dlfw_to_mem_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 src, u32 dest,
u32 size);
static enum halmac_ret_status
dlfw_end_flow_88xx(struct halmac_adapter *adapter);
static enum halmac_ret_status
free_dl_fw_end_flow_88xx(struct halmac_adapter *adapter);
static enum halmac_ret_status
send_fwpkt_88xx(struct halmac_adapter *adapter, u16 pg_addr, u8 *fw_bin,
u32 size);
static enum halmac_ret_status
iddma_dlfw_88xx(struct halmac_adapter *adapter, u32 src, u32 dest, u32 len,
u8 first);
static enum halmac_ret_status
iddma_en_88xx(struct halmac_adapter *adapter, u32 src, u32 dest, u32 ctrl);
static enum halmac_ret_status
check_fw_chksum_88xx(struct halmac_adapter *adapter, u32 mem_addr);
static void
fw_fatal_status_debug_88xx(struct halmac_adapter *adapter);
static enum halmac_ret_status
start_dlfw_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size,
u32 dl_addr, u8 emem_only);
static enum halmac_ret_status
chk_fw_size_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size);
static void
chk_h2c_ver_88xx(struct halmac_adapter *adapter, u8 *fw_bin);
static void
wlan_cpu_en_88xx(struct halmac_adapter *adapter, u8 enable);
static void
pltfm_reset_88xx(struct halmac_adapter *adapter);
static enum halmac_ret_status
proc_send_general_info_88xx(struct halmac_adapter *adapter,
struct halmac_general_info *info);
static enum halmac_ret_status
proc_send_phydm_info_88xx(struct halmac_adapter *adapter,
struct halmac_general_info *info);
/**
* download_firmware_88xx() - download Firmware
* @adapter : the adapter of halmac
* @fw_bin : firmware bin
* @size : firmware size
* Author : KaiYuan Chang/Ivan Lin
* Return : enum halmac_ret_status
* More details of status code can be found in prototype document
*/
enum halmac_ret_status
download_firmware_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size)
{
u8 value8;
u32 bckp_idx = 0;
u32 lte_coex_backup = 0;
struct halmac_backup_info bckp[DLFW_RESTORE_REG_NUM];
enum halmac_ret_status status;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
if (adapter->halmac_state.mac_pwr == HALMAC_MAC_POWER_OFF)
return HALMAC_RET_POWER_STATE_INVALID;
PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__);
status = chk_fw_size_88xx(adapter, fw_bin, size);
if (status != HALMAC_RET_SUCCESS)
return status;
chk_h2c_ver_88xx(adapter, fw_bin);
if (adapter->halmac_state.wlcpu_mode == HALMAC_WLCPU_ENTER_SLEEP)
PLTFM_MSG_WARN("[WARN]Enter Sleep..zZZ\n");
adapter->halmac_state.dlfw_state = HALMAC_DLFW_NONE;
status = ltecoex_reg_read_88xx(adapter, 0x38, &lte_coex_backup);
if (status != HALMAC_RET_SUCCESS)
return status;
wlan_cpu_en_88xx(adapter, 0);
/* set HIQ to hi priority */
bckp[bckp_idx].length = 1;
bckp[bckp_idx].mac_register = REG_TXDMA_PQ_MAP + 1;
bckp[bckp_idx].value = HALMAC_REG_R8(REG_TXDMA_PQ_MAP + 1);
bckp_idx++;
value8 = HALMAC_DMA_MAPPING_HIGH << 6;
HALMAC_REG_W8(REG_TXDMA_PQ_MAP + 1, value8);
/* DLFW only use HIQ, map HIQ to hi priority */
adapter->pq_map[HALMAC_PQ_MAP_HI] = HALMAC_DMA_MAPPING_HIGH;
bckp[bckp_idx].length = 1;
bckp[bckp_idx].mac_register = REG_CR;
bckp[bckp_idx].value = HALMAC_REG_R8(REG_CR);
bckp_idx++;
bckp[bckp_idx].length = 4;
bckp[bckp_idx].mac_register = REG_H2CQ_CSR;
bckp[bckp_idx].value = BIT(31);
bckp_idx++;
value8 = BIT_HCI_TXDMA_EN | BIT_TXDMA_EN;
HALMAC_REG_W8(REG_CR, value8);
HALMAC_REG_W32(REG_H2CQ_CSR, BIT(31));
/* Config hi priority queue and public priority queue page number */
bckp[bckp_idx].length = 2;
bckp[bckp_idx].mac_register = REG_FIFOPAGE_INFO_1;
bckp[bckp_idx].value = HALMAC_REG_R16(REG_FIFOPAGE_INFO_1);
bckp_idx++;
bckp[bckp_idx].length = 4;
bckp[bckp_idx].mac_register = REG_RQPN_CTRL_2;
bckp[bckp_idx].value = HALMAC_REG_R32(REG_RQPN_CTRL_2) | BIT(31);
bckp_idx++;
HALMAC_REG_W16(REG_FIFOPAGE_INFO_1, 0x200);
HALMAC_REG_W32(REG_RQPN_CTRL_2, bckp[bckp_idx - 1].value);
/* Disable beacon related functions */
value8 = HALMAC_REG_R8(REG_BCN_CTRL);
bckp[bckp_idx].length = 1;
bckp[bckp_idx].mac_register = REG_BCN_CTRL;
bckp[bckp_idx].value = value8;
bckp_idx++;
value8 = (u8)((value8 & (~BIT(3))) | BIT(4));
HALMAC_REG_W8(REG_BCN_CTRL, value8);
if (adapter->intf == HALMAC_INTERFACE_SDIO)
HALMAC_REG_R32(REG_SDIO_FREE_TXPG);
pltfm_reset_88xx(adapter);
status = start_dlfw_88xx(adapter, fw_bin, size, 0, 0);
restore_mac_reg_88xx(adapter, bckp, DLFW_RESTORE_REG_NUM);
if (status != HALMAC_RET_SUCCESS)
goto DLFW_FAIL;
status = dlfw_end_flow_88xx(adapter);
if (status != HALMAC_RET_SUCCESS)
goto DLFW_FAIL;
status = ltecoex_reg_write_88xx(adapter, 0x38, lte_coex_backup);
if (status != HALMAC_RET_SUCCESS)
return status;
adapter->halmac_state.dlfw_state = HALMAC_DLFW_DONE;
PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__);
return HALMAC_RET_SUCCESS;
DLFW_FAIL:
/* Disable FWDL_EN */
value8 = HALMAC_REG_R8(REG_MCUFW_CTRL);
value8 &= ~BIT(0);
HALMAC_REG_W8(REG_MCUFW_CTRL, value8);
value8 = HALMAC_REG_R8(REG_SYS_FUNC_EN + 1);
value8 |= BIT(2);
HALMAC_REG_W8(REG_SYS_FUNC_EN + 1, value8);
if (ltecoex_reg_write_88xx(adapter, 0x38, lte_coex_backup) !=
HALMAC_RET_SUCCESS)
return HALMAC_RET_LTECOEX_READY_FAIL;
return status;
}
static enum halmac_ret_status
start_dlfw_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size,
u32 dl_addr, u8 emem_only)
{
u8 *cur_fw;
u16 value16;
u32 imem_size;
u32 dmem_size;
u32 emem_size = 0;
u32 addr;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
enum halmac_ret_status status;
dmem_size = *((u32 *)(fw_bin + WLAN_FW_HDR_DMEM_SIZE));
imem_size = *((u32 *)(fw_bin + WLAN_FW_HDR_IMEM_SIZE));
if (0 != ((*(fw_bin + WLAN_FW_HDR_MEM_USAGE)) & BIT(4)))
emem_size = *((u32 *)(fw_bin + WLAN_FW_HDR_EMEM_SIZE));
dmem_size = rtk_le32_to_cpu(dmem_size);
imem_size = rtk_le32_to_cpu(imem_size);
emem_size = rtk_le32_to_cpu(emem_size);
dmem_size += WLAN_FW_HDR_CHKSUM_SIZE;
imem_size += WLAN_FW_HDR_CHKSUM_SIZE;
if (emem_size != 0)
emem_size += WLAN_FW_HDR_CHKSUM_SIZE;
if (emem_only == 1) {
if (!emem_size)
return HALMAC_RET_SUCCESS;
goto DLFW_EMEM;
}
value16 = (u16)(HALMAC_REG_R16(REG_MCUFW_CTRL) & 0x3800);
value16 |= BIT(0);
HALMAC_REG_W16(REG_MCUFW_CTRL, value16);
cur_fw = fw_bin + WLAN_FW_HDR_SIZE;
addr = *((u32 *)(fw_bin + WLAN_FW_HDR_DMEM_ADDR));
addr = rtk_le32_to_cpu(addr) & ~BIT(31);
status = dlfw_to_mem_88xx(adapter, cur_fw, 0, addr, dmem_size);
if (status != HALMAC_RET_SUCCESS)
return status;
cur_fw = fw_bin + WLAN_FW_HDR_SIZE + dmem_size;
addr = *((u32 *)(fw_bin + WLAN_FW_HDR_IMEM_ADDR));
addr = rtk_le32_to_cpu(addr) & ~BIT(31);
status = dlfw_to_mem_88xx(adapter, cur_fw, 0, addr, imem_size);
if (status != HALMAC_RET_SUCCESS)
return status;
DLFW_EMEM:
if (emem_size) {
cur_fw = fw_bin + WLAN_FW_HDR_SIZE +
dmem_size + imem_size;
addr = *((u32 *)(fw_bin + WLAN_FW_HDR_EMEM_ADDR));
addr = rtk_le32_to_cpu(addr) & ~BIT(31);
status = dlfw_to_mem_88xx(adapter, cur_fw, dl_addr << 7, addr,
emem_size);
if (status != HALMAC_RET_SUCCESS)
return status;
if (emem_only == 1)
return HALMAC_RET_SUCCESS;
}
update_fw_info_88xx(adapter, fw_bin);
init_ofld_feature_state_machine_88xx(adapter);
return HALMAC_RET_SUCCESS;
}
static void
chk_h2c_ver_88xx(struct halmac_adapter *adapter, u8 *fw_bin)
{
u16 halmac_h2c_ver;
u16 fw_h2c_ver;
fw_h2c_ver = *((u16 *)(fw_bin + WLAN_FW_HDR_H2C_FMT_VER));
fw_h2c_ver = rtk_le16_to_cpu(fw_h2c_ver);
halmac_h2c_ver = H2C_FORMAT_VERSION;
PLTFM_MSG_TRACE("[TRACE]halmac h2c ver = %x, fw h2c ver = %x!!\n",
halmac_h2c_ver, fw_h2c_ver);
if (fw_h2c_ver != halmac_h2c_ver)
PLTFM_MSG_WARN("[WARN]H2C/C2H ver is compatible!!\n");
}
static enum halmac_ret_status
chk_fw_size_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 size)
{
u32 imem_size;
u32 dmem_size;
u32 emem_size = 0;
u32 real_size;
if (size < WLAN_FW_HDR_SIZE) {
PLTFM_MSG_ERR("[ERR]FW size error!\n");
return HALMAC_RET_FW_SIZE_ERR;
}
dmem_size = *((u32 *)(fw_bin + WLAN_FW_HDR_DMEM_SIZE));
imem_size = *((u32 *)(fw_bin + WLAN_FW_HDR_IMEM_SIZE));
if (0 != ((*(fw_bin + WLAN_FW_HDR_MEM_USAGE)) & BIT(4)))
emem_size = *((u32 *)(fw_bin + WLAN_FW_HDR_EMEM_SIZE));
dmem_size = rtk_le32_to_cpu(dmem_size);
imem_size = rtk_le32_to_cpu(imem_size);
emem_size = rtk_le32_to_cpu(emem_size);
dmem_size += WLAN_FW_HDR_CHKSUM_SIZE;
imem_size += WLAN_FW_HDR_CHKSUM_SIZE;
if (emem_size != 0)
emem_size += WLAN_FW_HDR_CHKSUM_SIZE;
real_size = WLAN_FW_HDR_SIZE + dmem_size + imem_size + emem_size;
if (size != real_size) {
PLTFM_MSG_ERR("[ERR]size != real size!\n");
return HALMAC_RET_FW_SIZE_ERR;
}
return HALMAC_RET_SUCCESS;
}
static void
wlan_cpu_en_88xx(struct halmac_adapter *adapter, u8 enable)
{
u8 value8;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
if (enable == 1) {
/* cpu io interface enable or disable */
value8 = HALMAC_REG_R8(REG_RSV_CTRL + 1);
value8 |= BIT(0);
HALMAC_REG_W8(REG_RSV_CTRL + 1, value8);
/* cpu enable or disable */
value8 = HALMAC_REG_R8(REG_SYS_FUNC_EN + 1);
value8 |= BIT(2);
HALMAC_REG_W8(REG_SYS_FUNC_EN + 1, value8);
} else {
/* cpu enable or disable */
value8 = HALMAC_REG_R8(REG_SYS_FUNC_EN + 1);
value8 &= ~BIT(2);
HALMAC_REG_W8(REG_SYS_FUNC_EN + 1, value8);
/* cpu io interface enable or disable */
value8 = HALMAC_REG_R8(REG_RSV_CTRL + 1);
value8 &= ~BIT(0);
HALMAC_REG_W8(REG_RSV_CTRL + 1, value8);
}
}
static void
pltfm_reset_88xx(struct halmac_adapter *adapter)
{
u8 value8;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
value8 = HALMAC_REG_R8(REG_CPU_DMEM_CON + 2) & ~BIT(0);
HALMAC_REG_W8(REG_CPU_DMEM_CON + 2, value8);
/* For 8822B & 8821C clock sync issue */
if (adapter->chip_id == HALMAC_CHIP_ID_8821C ||
adapter->chip_id == HALMAC_CHIP_ID_8822B) {
value8 = HALMAC_REG_R8(REG_SYS_CLK_CTRL + 1) & ~BIT(6);
HALMAC_REG_W8(REG_SYS_CLK_CTRL + 1, value8);
}
value8 = HALMAC_REG_R8(REG_CPU_DMEM_CON + 2) | BIT(0);
HALMAC_REG_W8(REG_CPU_DMEM_CON + 2, value8);
if (adapter->chip_id == HALMAC_CHIP_ID_8821C ||
adapter->chip_id == HALMAC_CHIP_ID_8822B) {
value8 = HALMAC_REG_R8(REG_SYS_CLK_CTRL + 1) | BIT(6);
HALMAC_REG_W8(REG_SYS_CLK_CTRL + 1, value8);
}
}
/**
* free_download_firmware_88xx() - download specific memory firmware
* @adapter
* @mem_sel : memory selection
* @fw_bin : firmware bin
* @size : firmware size
* Author : KaiYuan Chang/Ivan Lin
* Return : enum halmac_ret_status
*/
enum halmac_ret_status
free_download_firmware_88xx(struct halmac_adapter *adapter,
enum halmac_dlfw_mem mem_sel, u8 *fw_bin, u32 size)
{
u8 tx_pause_bckp;
u32 dl_addr;
u32 dlfw_size_bckp;
enum halmac_ret_status status;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS)
return HALMAC_RET_NO_DLFW;
PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__);
status = chk_fw_size_88xx(adapter, fw_bin, size);
if (status != HALMAC_RET_SUCCESS)
return status;
if (((*(fw_bin + WLAN_FW_HDR_MEM_USAGE)) & BIT(4)) == 0)
return HALMAC_RET_SUCCESS;
dlfw_size_bckp = adapter->dlfw_pkt_size;
if (mem_sel == HALMAC_DLFW_MEM_EMEM) {
dl_addr = 0;
} else {
dl_addr = adapter->txff_alloc.rsvd_h2c_info_addr;
adapter->dlfw_pkt_size = (dlfw_size_bckp > DLFW_RSVDPG_SIZE) ?
DLFW_RSVDPG_SIZE : dlfw_size_bckp;
}
tx_pause_bckp = HALMAC_REG_R8(REG_TXPAUSE);
HALMAC_REG_W8(REG_TXPAUSE, tx_pause_bckp | BIT(7));
status = start_dlfw_88xx(adapter, fw_bin, size, dl_addr, 1);
if (status != HALMAC_RET_SUCCESS)
goto DL_FREE_FW_END;
status = free_dl_fw_end_flow_88xx(adapter);
DL_FREE_FW_END:
HALMAC_REG_W8(REG_TXPAUSE, tx_pause_bckp);
adapter->dlfw_pkt_size = dlfw_size_bckp;
PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__);
return status;
}
/**
* get_fw_version_88xx() - get FW version
* @adapter : the adapter of halmac
* @ver : fw version info
* Author : Ivan Lin
* Return : enum halmac_ret_status
* More details of status code can be found in prototype document
*/
enum halmac_ret_status
get_fw_version_88xx(struct halmac_adapter *adapter,
struct halmac_fw_version *ver)
{
struct halmac_fw_version *info = &adapter->fw_ver;
if (!ver)
return HALMAC_RET_NULL_POINTER;
if (adapter->halmac_state.dlfw_state == HALMAC_DLFW_NONE)
return HALMAC_RET_NO_DLFW;
ver->version = info->version;
ver->sub_version = info->sub_version;
ver->sub_index = info->sub_index;
ver->h2c_version = info->h2c_version;
ver->build_time.month = info->build_time.month;
ver->build_time.date = info->build_time.date;
ver->build_time.hour = info->build_time.hour;
ver->build_time.min = info->build_time.min;
ver->build_time.year = info->build_time.year;
return HALMAC_RET_SUCCESS;
}
static enum halmac_ret_status
update_fw_info_88xx(struct halmac_adapter *adapter, u8 *fw_bin)
{
struct halmac_fw_version *info = &adapter->fw_ver;
info->version = *((u16 *)(fw_bin + WLAN_FW_HDR_VERSION));
info->version = rtk_le16_to_cpu(info->version);
info->sub_version = *(fw_bin + WLAN_FW_HDR_SUBVERSION);
info->sub_index = *(fw_bin + WLAN_FW_HDR_SUBINDEX);
info->h2c_version = *((u16 *)(fw_bin + WLAN_FW_HDR_H2C_FMT_VER));
info->h2c_version = rtk_le16_to_cpu(info->h2c_version);
info->build_time.month = *(fw_bin + WLAN_FW_HDR_MONTH);
info->build_time.date = *(fw_bin + WLAN_FW_HDR_DATE);
info->build_time.hour = *(fw_bin + WLAN_FW_HDR_HOUR);
info->build_time.min = *(fw_bin + WLAN_FW_HDR_MIN);
info->build_time.year = *((u16 *)(fw_bin + WLAN_FW_HDR_YEAR));
info->build_time.year = rtk_le16_to_cpu(info->build_time.year);
PLTFM_MSG_TRACE("[TRACE]=== FW info ===\n");
PLTFM_MSG_TRACE("[TRACE]ver : %X\n", info->version);
PLTFM_MSG_TRACE("[TRACE]sub-ver : %X\n",
info->sub_version);
PLTFM_MSG_TRACE("[TRACE]sub-idx : %X\n",
info->sub_index);
PLTFM_MSG_TRACE("[TRACE]build : %d/%d/%d %d:%d\n",
info->build_time.year, info->build_time.month,
info->build_time.date, info->build_time.hour,
info->build_time.min);
return HALMAC_RET_SUCCESS;
}
static enum halmac_ret_status
dlfw_to_mem_88xx(struct halmac_adapter *adapter, u8 *fw_bin, u32 src, u32 dest,
u32 size)
{
u8 first_part;
u32 mem_offset;
u32 residue_size;
u32 pkt_size;
enum halmac_ret_status status;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
mem_offset = 0;
first_part = 1;
residue_size = size;
HALMAC_REG_W32_SET(REG_DDMA_CH0CTRL, BIT_DDMACH0_RESET_CHKSUM_STS);
while (residue_size != 0) {
if (residue_size >= adapter->dlfw_pkt_size)
pkt_size = adapter->dlfw_pkt_size;
else
pkt_size = residue_size;
status = send_fwpkt_88xx(adapter, (u16)(src >> 7),
fw_bin + mem_offset, pkt_size);
if (status != HALMAC_RET_SUCCESS) {
PLTFM_MSG_ERR("[ERR]send fw pkt!!");
return status;
}
status = iddma_dlfw_88xx(adapter,
OCPBASE_TXBUF_88XX +
src + adapter->hw_cfg_info.txdesc_size,
dest + mem_offset, pkt_size,
first_part);
if (status != HALMAC_RET_SUCCESS) {
PLTFM_MSG_ERR("[ERR]iddma dlfw!!");
return status;
}
first_part = 0;
mem_offset += pkt_size;
residue_size -= pkt_size;
}
status = check_fw_chksum_88xx(adapter, dest);
if (status != HALMAC_RET_SUCCESS) {
PLTFM_MSG_ERR("[ERR]chk fw chksum!!");
return status;
}
return HALMAC_RET_SUCCESS;
}
static void
restore_mac_reg_88xx(struct halmac_adapter *adapter,
struct halmac_backup_info *info, u32 num)
{
u8 len;
u32 i;
u32 reg;
u32 value;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
struct halmac_backup_info *curr_info = info;
for (i = 0; i < num; i++) {
reg = curr_info->mac_register;
value = curr_info->value;
len = curr_info->length;
if (len == 1)
HALMAC_REG_W8(reg, (u8)value);
else if (len == 2)
HALMAC_REG_W16(reg, (u16)value);
else if (len == 4)
HALMAC_REG_W32(reg, value);
curr_info++;
}
}
static enum halmac_ret_status
dlfw_end_flow_88xx(struct halmac_adapter *adapter)
{
u16 fw_ctrl;
u32 cnt;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
HALMAC_REG_W32(REG_TXDMA_STATUS, BIT(2));
/* Check IMEM & DMEM checksum is OK or not */
fw_ctrl = HALMAC_REG_R16(REG_MCUFW_CTRL);
if ((fw_ctrl & 0x50) != 0x50)
return HALMAC_RET_IDMEM_CHKSUM_FAIL;
HALMAC_REG_W16(REG_MCUFW_CTRL, (fw_ctrl | BIT_FW_DW_RDY) & ~BIT(0));
wlan_cpu_en_88xx(adapter, 1);
PLTFM_MSG_TRACE("[TRACE]Dlfw OK, enable CPU\n");
cnt = 5000;
while (HALMAC_REG_R16(REG_MCUFW_CTRL) != 0xC078) {
if (cnt == 0) {
PLTFM_MSG_ERR("[ERR]Check 0x80 = 0xC078 fail\n");
if ((HALMAC_REG_R32(REG_FW_DBG7) & 0xFFFFFF00) ==
ILLEGAL_KEY_GROUP) {
PLTFM_MSG_ERR("[ERR]Key!!\n");
return HALMAC_RET_ILLEGAL_KEY_FAIL;
}
return HALMAC_RET_FW_READY_CHK_FAIL;
}
cnt--;
PLTFM_DELAY_US(50);
}
PLTFM_MSG_TRACE("[TRACE]0x80=0xC078, cnt=%d\n", cnt);
return HALMAC_RET_SUCCESS;
}
static enum halmac_ret_status
free_dl_fw_end_flow_88xx(struct halmac_adapter *adapter)
{
u32 cnt;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
cnt = 100;
while (HALMAC_REG_R8(REG_HMETFR + 3) != 0) {
cnt--;
if (cnt == 0) {
PLTFM_MSG_ERR("[ERR]0x1CF != 0\n");
return HALMAC_RET_DLFW_FAIL;
}
PLTFM_DELAY_US(50);
}
HALMAC_REG_W8(REG_HMETFR + 3, ID_INFORM_DLEMEM_RDY);
cnt = 10000;
while (HALMAC_REG_R8(REG_MCU_TST_CFG) != ID_CHECK_DLEMEM_RDY) {
cnt--;
if (cnt == 0) {
PLTFM_MSG_ERR("[ERR]0x84 != 0x80\n");
return HALMAC_RET_DLFW_FAIL;
}
PLTFM_DELAY_US(50);
}
HALMAC_REG_W8(REG_MCU_TST_CFG, 0);
return HALMAC_RET_SUCCESS;
}
static enum halmac_ret_status
send_fwpkt_88xx(struct halmac_adapter *adapter, u16 pg_addr, u8 *fw_bin,
u32 size)
{
enum halmac_ret_status status;
status = dl_rsvd_page_88xx(adapter, pg_addr, fw_bin, size);
if (status != HALMAC_RET_SUCCESS)
PLTFM_MSG_ERR("[ERR]dl rsvd page!!\n");
return status;
}
static enum halmac_ret_status
iddma_dlfw_88xx(struct halmac_adapter *adapter, u32 src, u32 dest, u32 len,
u8 first)
{
u32 cnt;
u32 ch0_ctrl = (u32)(BIT_DDMACH0_CHKSUM_EN | BIT_DDMACH0_OWN);
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
cnt = HALMC_DDMA_POLLING_COUNT;
while (HALMAC_REG_R32(REG_DDMA_CH0CTRL) & BIT_DDMACH0_OWN) {
cnt--;
if (cnt == 0) {
PLTFM_MSG_ERR("[ERR]ch0 ready!!\n");
return HALMAC_RET_DDMA_FAIL;
}
}
ch0_ctrl |= (len & BIT_MASK_DDMACH0_DLEN);
if (first == 0)
ch0_ctrl |= BIT_DDMACH0_CHKSUM_CONT;
if (iddma_en_88xx(adapter, src, dest, ch0_ctrl) !=
HALMAC_RET_SUCCESS) {
PLTFM_MSG_ERR("[ERR]iddma en!!\n");
return HALMAC_RET_DDMA_FAIL;
}
return HALMAC_RET_SUCCESS;
}
static enum halmac_ret_status
iddma_en_88xx(struct halmac_adapter *adapter, u32 src, u32 dest, u32 ctrl)
{
u32 cnt = HALMC_DDMA_POLLING_COUNT;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
HALMAC_REG_W32(REG_DDMA_CH0SA, src);
HALMAC_REG_W32(REG_DDMA_CH0DA, dest);
HALMAC_REG_W32(REG_DDMA_CH0CTRL, ctrl);
while (HALMAC_REG_R32(REG_DDMA_CH0CTRL) & BIT_DDMACH0_OWN) {
cnt--;
if (cnt == 0)
return HALMAC_RET_DDMA_FAIL;
}
return HALMAC_RET_SUCCESS;
}
static enum halmac_ret_status
check_fw_chksum_88xx(struct halmac_adapter *adapter, u32 mem_addr)
{
u8 fw_ctrl;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
fw_ctrl = HALMAC_REG_R8(REG_MCUFW_CTRL);
if (HALMAC_REG_R32(REG_DDMA_CH0CTRL) & BIT_DDMACH0_CHKSUM_STS) {
if (mem_addr < OCPBASE_DMEM_88XX) {
fw_ctrl |= BIT_IMEM_DW_OK;
fw_ctrl &= ~BIT_IMEM_CHKSUM_OK;
HALMAC_REG_W8(REG_MCUFW_CTRL, fw_ctrl);
} else {
fw_ctrl |= BIT_DMEM_DW_OK;
fw_ctrl &= ~BIT_DMEM_CHKSUM_OK;
HALMAC_REG_W8(REG_MCUFW_CTRL, fw_ctrl);
}
PLTFM_MSG_ERR("[ERR]fw chksum!!\n");
return HALMAC_RET_FW_CHECKSUM_FAIL;
}
if (mem_addr < OCPBASE_DMEM_88XX) {
fw_ctrl |= (BIT_IMEM_DW_OK | BIT_IMEM_CHKSUM_OK);
HALMAC_REG_W8(REG_MCUFW_CTRL, fw_ctrl);
} else {
fw_ctrl |= (BIT_DMEM_DW_OK | BIT_DMEM_CHKSUM_OK);
HALMAC_REG_W8(REG_MCUFW_CTRL, fw_ctrl);
}
return HALMAC_RET_SUCCESS;
}
/**
* check_fw_status_88xx() -check fw status
* @adapter : the adapter of halmac
* @status : fw status
* Author : KaiYuan Chang/Ivan Lin
* Return : enum halmac_ret_status
* More details of status code can be found in prototype document
*/
enum halmac_ret_status
check_fw_status_88xx(struct halmac_adapter *adapter, u8 *fw_status)
{
u32 cnt;
u32 fw_dbg6;
u32 fw_pc;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
enum halmac_ret_status status = HALMAC_RET_SUCCESS;
PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__);
*fw_status = _TRUE;
fw_dbg6 = HALMAC_REG_R32(REG_FW_DBG6);
if (fw_dbg6 != 0) {
PLTFM_MSG_ERR("[ERR]REG_FW_DBG6 !=0\n");
if ((fw_dbg6 & FW_STATUS_CHK_WARN) != 0)
PLTFM_MSG_WARN("[WARN]fw status(warn):%X\n", fw_dbg6);
if ((fw_dbg6 & FW_STATUS_CHK_ERR) != 0)
PLTFM_MSG_ERR("[ERR]fw status(err):%X\n", fw_dbg6);
if ((fw_dbg6 & FW_STATUS_CHK_FATAL) != 0) {
PLTFM_MSG_ERR("[ERR]fw status(fatal):%X\n", fw_dbg6);
fw_fatal_status_debug_88xx(adapter);
*fw_status = _FALSE;
return status;
}
}
fw_pc = HALMAC_REG_R32(REG_FW_DBG7);
cnt = 10;
while (HALMAC_REG_R32(REG_FW_DBG7) == fw_pc) {
cnt--;
if (cnt == 0)
break;
}
if (cnt == 0) {
cnt = 200;
while (HALMAC_REG_R32(REG_FW_DBG7) == fw_pc) {
cnt--;
if (cnt == 0) {
PLTFM_MSG_ERR("[ERR]fw pc\n");
*fw_status = _FALSE;
return status;
}
PLTFM_DELAY_US(50);
}
}
PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__);
return status;
}
static void
fw_fatal_status_debug_88xx(struct halmac_adapter *adapter)
{
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
PLTFM_MSG_ERR("[ERR]0x%X = %X\n",
REG_FW_DBG6, HALMAC_REG_R32(REG_FW_DBG6));
PLTFM_MSG_ERR("[ERR]0x%X = %X\n",
REG_ARFR5, HALMAC_REG_R32(REG_ARFR5));
PLTFM_MSG_ERR("[ERR]0x%X = %X\n",
REG_MCUTST_I, HALMAC_REG_R32(REG_MCUTST_I));
}
enum halmac_ret_status
dump_fw_dmem_88xx(struct halmac_adapter *adapter, u8 *dmem, u32 *size)
{
return HALMAC_RET_SUCCESS;
}
/**
* cfg_max_dl_size_88xx() - config max download FW size
* @adapter : the adapter of halmac
* @size : max download fw size
*
* Halmac uses this setting to set max packet size for
* download FW.
* If user has not called this API, halmac use default
* setting for download FW
* Note1 : size need multiple of 2
* Note2 : max size is 31K
*
* Author : Ivan Lin/KaiYuan Chang
* Return : enum halmac_ret_status
* More details of status code can be found in prototype document
*/
enum halmac_ret_status
cfg_max_dl_size_88xx(struct halmac_adapter *adapter, u32 size)
{
PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__);
if (size > DLFW_PKT_SIZE_LIMIT) {
PLTFM_MSG_ERR("[ERR]size > max dl size!\n");
return HALMAC_RET_CFG_DLFW_SIZE_FAIL;
}
if ((size & (2 - 1)) != 0) {
PLTFM_MSG_ERR("[ERR]not multiple of 2!\n");
return HALMAC_RET_CFG_DLFW_SIZE_FAIL;
}
adapter->dlfw_pkt_size = size;
PLTFM_MSG_TRACE("[TRACE]Cfg max size:%X\n", size);
PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__);
return HALMAC_RET_SUCCESS;
}
/**
* enter_cpu_sleep_mode_88xx() -wlan cpu enter sleep mode
* @adapter : the adapter of halmac
* Author : Ivan Lin
* Return : enum halmac_ret_status
* More details of status code can be found in prototype document
*/
enum halmac_ret_status
enter_cpu_sleep_mode_88xx(struct halmac_adapter *adapter)
{
u32 cnt;
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
enum halmac_wlcpu_mode *cur_mode = &adapter->halmac_state.wlcpu_mode;
if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS)
return HALMAC_RET_NO_DLFW;
if (*cur_mode != HALMAC_WLCPU_ACTIVE)
return HALMAC_RET_ERROR_STATE;
cnt = 100;
while (HALMAC_REG_R8(REG_HMETFR + 3) != 0) {
cnt--;
if (cnt == 0) {
PLTFM_MSG_ERR("[ERR]0x1CF != 0\n");
return HALMAC_RET_STATE_INCORRECT;
}
PLTFM_DELAY_US(50);
}
HALMAC_REG_W8(REG_HMETFR + 3, ID_INFORM_ENETR_CPU_SLEEP);
*cur_mode = HALMAC_WLCPU_ENTER_SLEEP;
return HALMAC_RET_SUCCESS;
}
/**
* get_cpu_mode_88xx() -get wlcpu mode
* @adapter : the adapter of halmac
* @mode : cpu mode
* Author : Ivan Lin
* Return : enum halmac_ret_status
* More details of status code can be found in prototype document
*/
enum halmac_ret_status
get_cpu_mode_88xx(struct halmac_adapter *adapter,
enum halmac_wlcpu_mode *mode)
{
struct halmac_api *api = (struct halmac_api *)adapter->halmac_api;
enum halmac_wlcpu_mode *cur_mode = &adapter->halmac_state.wlcpu_mode;
if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS)
return HALMAC_RET_NO_DLFW;
if (*cur_mode == HALMAC_WLCPU_ACTIVE) {
*mode = HALMAC_WLCPU_ACTIVE;
return HALMAC_RET_SUCCESS;
}
if (*cur_mode == HALMAC_WLCPU_SLEEP) {
*mode = HALMAC_WLCPU_SLEEP;
return HALMAC_RET_SUCCESS;
}
if (HALMAC_REG_R8(REG_MCU_TST_CFG) == ID_CHECK_ENETR_CPU_SLEEP) {
*mode = HALMAC_WLCPU_SLEEP;
HALMAC_REG_W8(REG_MCU_TST_CFG, 0);
} else {
*mode = HALMAC_WLCPU_ENTER_SLEEP;
}
return HALMAC_RET_SUCCESS;
}
/**
* send_general_info_88xx() -send general information to FW
* @adapter : the adapter of halmac
* @info : general information
* Author : KaiYuan Chang/Ivan Lin
* Return : enum halmac_ret_status
* More details of status code can be found in prototype document
*/
enum halmac_ret_status
send_general_info_88xx(struct halmac_adapter *adapter,
struct halmac_general_info *info)
{
enum halmac_ret_status status = HALMAC_RET_SUCCESS;
if (halmac_fw_validate(adapter) != HALMAC_RET_SUCCESS)
return HALMAC_RET_NO_DLFW;
if (adapter->fw_ver.h2c_version < 4)
return HALMAC_RET_FW_NO_SUPPORT;
PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__);
if (adapter->halmac_state.dlfw_state == HALMAC_DLFW_NONE) {
PLTFM_MSG_ERR("[ERR]no dl fw!!\n");
return HALMAC_RET_NO_DLFW;
}
status = proc_send_general_info_88xx(adapter, info);
if (status != HALMAC_RET_SUCCESS) {
PLTFM_MSG_ERR("[ERR]send gen info!!\n");
return status;
}
status = proc_send_phydm_info_88xx(adapter, info);
if (status != HALMAC_RET_SUCCESS) {
PLTFM_MSG_ERR("[ERR]send phydm info\n");
return status;
}
if (adapter->halmac_state.dlfw_state == HALMAC_DLFW_DONE)
adapter->halmac_state.dlfw_state = HALMAC_GEN_INFO_SENT;
PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__);
return HALMAC_RET_SUCCESS;
}
static enum halmac_ret_status
proc_send_general_info_88xx(struct halmac_adapter *adapter,
struct halmac_general_info *info)
{
u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 };
u16 seq_num = 0;
struct halmac_h2c_header_info hdr_info;
enum halmac_ret_status status = HALMAC_RET_SUCCESS;
PLTFM_MSG_TRACE("[TRACE]%s\n", __func__);
GENERAL_INFO_SET_FW_TX_BOUNDARY(h2c_buf,
adapter->txff_alloc.rsvd_fw_txbuf_addr -
adapter->txff_alloc.rsvd_boundary);
hdr_info.sub_cmd_id = SUB_CMD_ID_GENERAL_INFO;
hdr_info.content_size = 4;
hdr_info.ack = _FALSE;
set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num);
status = send_h2c_pkt_88xx(adapter, h2c_buf);
if (status != HALMAC_RET_SUCCESS)
PLTFM_MSG_ERR("[ERR]send h2c!!\n");
return status;
}
static enum halmac_ret_status
proc_send_phydm_info_88xx(struct halmac_adapter *adapter,
struct halmac_general_info *info)
{
u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 };
u16 seq_num = 0;
struct halmac_h2c_header_info hdr_info;
enum halmac_ret_status status = HALMAC_RET_SUCCESS;
PLTFM_MSG_TRACE("[TRACE]%s\n", __func__);
PHYDM_INFO_SET_REF_TYPE(h2c_buf, info->rfe_type);
PHYDM_INFO_SET_RF_TYPE(h2c_buf, info->rf_type);
PHYDM_INFO_SET_CUT_VER(h2c_buf, adapter->chip_ver);
PHYDM_INFO_SET_RX_ANT_STATUS(h2c_buf, info->rx_ant_status);
PHYDM_INFO_SET_TX_ANT_STATUS(h2c_buf, info->tx_ant_status);
hdr_info.sub_cmd_id = SUB_CMD_ID_PHYDM_INFO;
hdr_info.content_size = 8;
hdr_info.ack = _FALSE;
set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num);
status = send_h2c_pkt_88xx(adapter, h2c_buf);
if (status != HALMAC_RET_SUCCESS)
PLTFM_MSG_ERR("[ERR]send h2c!!\n");
return status;
}
/**
* drv_fwctrl_88xx() - send drv-defined h2c pkt
* @adapter : the adapter of halmac
* @payload : no include offload pkt h2c header
* @size : no include offload pkt h2c header
* Author : Ivan Lin
* Return : enum halmac_ret_status
* More details of status code can be found in prototype document
*/
enum halmac_ret_status
drv_fwctrl_88xx(struct halmac_adapter *adapter, u8 *payload, u32 size, u8 ack)
{
u8 h2c_buf[H2C_PKT_SIZE_88XX] = { 0 };
u16 seq_num = 0;
struct halmac_h2c_header_info hdr_info;
enum halmac_ret_status status = HALMAC_RET_SUCCESS;
PLTFM_MSG_TRACE("[TRACE]%s ===>\n", __func__);
if (!payload)
return HALMAC_RET_DATA_BUF_NULL;
if (size > H2C_PKT_SIZE_88XX - H2C_PKT_HDR_SIZE_88XX)
return HALMAC_RET_DATA_SIZE_INCORRECT;
PLTFM_MEMCPY(h2c_buf + H2C_PKT_HDR_SIZE_88XX, payload, size);
hdr_info.sub_cmd_id = SUB_CMD_ID_FW_FWCTRL;
hdr_info.content_size = (u16)size;
hdr_info.ack = ack;
set_h2c_pkt_hdr_88xx(adapter, h2c_buf, &hdr_info, &seq_num);
status = send_h2c_pkt_88xx(adapter, h2c_buf);
if (status != HALMAC_RET_SUCCESS)
PLTFM_MSG_ERR("[ERR]send h2c!!\n");
PLTFM_MSG_TRACE("[TRACE]%s <===\n", __func__);
return status;
}
#endif /* HALMAC_88XX_SUPPORT */
Reference in New Issue Copy Permalink