linux_dsm_epyc7002/drivers/net/wireless/rsi/rsi_91x_hal.c
Allen Pais 531f3ce953 drivers: net: rsi_91x: use setup_timer() helper.
Use setup_timer function instead of initializing timer with the
    function and data fields.

Signed-off-by: Allen Pais <allen.lkml@gmail.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-09-21 11:44:39 -07:00

922 lines
25 KiB
C

/**
* Copyright (c) 2014 Redpine Signals Inc.
*
* Permission to use, copy, modify, and/or distribute this software for any
* purpose with or without fee is hereby granted, provided that the above
* copyright notice and this permission notice appear in all copies.
*
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*/
#include <linux/firmware.h>
#include "rsi_mgmt.h"
#include "rsi_hal.h"
#include "rsi_sdio.h"
#include "rsi_common.h"
/* FLASH Firmware */
static struct ta_metadata metadata_flash_content[] = {
{"flash_content", 0x00010000},
{"rsi/rs9113_wlan_qspi.rps", 0x00010000},
};
int rsi_send_pkt_to_bus(struct rsi_common *common, struct sk_buff *skb)
{
struct rsi_hw *adapter = common->priv;
int status;
status = adapter->host_intf_ops->write_pkt(common->priv,
skb->data, skb->len);
return status;
}
static int rsi_prepare_mgmt_desc(struct rsi_common *common, struct sk_buff *skb)
{
struct rsi_hw *adapter = common->priv;
struct ieee80211_hdr *wh = NULL;
struct ieee80211_tx_info *info;
struct ieee80211_conf *conf = &adapter->hw->conf;
struct ieee80211_vif *vif = adapter->vifs[0];
struct rsi_mgmt_desc *mgmt_desc;
struct skb_info *tx_params;
struct ieee80211_bss_conf *bss = NULL;
struct xtended_desc *xtend_desc = NULL;
u8 header_size;
u32 dword_align_bytes = 0;
if (skb->len > MAX_MGMT_PKT_SIZE) {
rsi_dbg(INFO_ZONE, "%s: Dropping mgmt pkt > 512\n", __func__);
return -EINVAL;
}
info = IEEE80211_SKB_CB(skb);
tx_params = (struct skb_info *)info->driver_data;
/* Update header size */
header_size = FRAME_DESC_SZ + sizeof(struct xtended_desc);
if (header_size > skb_headroom(skb)) {
rsi_dbg(ERR_ZONE,
"%s: Failed to add extended descriptor\n",
__func__);
return -ENOSPC;
}
skb_push(skb, header_size);
dword_align_bytes = ((unsigned long)skb->data & 0x3f);
if (dword_align_bytes > skb_headroom(skb)) {
rsi_dbg(ERR_ZONE,
"%s: Failed to add dword align\n", __func__);
return -ENOSPC;
}
skb_push(skb, dword_align_bytes);
header_size += dword_align_bytes;
tx_params->internal_hdr_size = header_size;
memset(&skb->data[0], 0, header_size);
bss = &info->control.vif->bss_conf;
wh = (struct ieee80211_hdr *)&skb->data[header_size];
mgmt_desc = (struct rsi_mgmt_desc *)skb->data;
xtend_desc = (struct xtended_desc *)&skb->data[FRAME_DESC_SZ];
rsi_set_len_qno(&mgmt_desc->len_qno, (skb->len - FRAME_DESC_SZ),
RSI_WIFI_MGMT_Q);
mgmt_desc->frame_type = TX_DOT11_MGMT;
mgmt_desc->header_len = MIN_802_11_HDR_LEN;
mgmt_desc->xtend_desc_size = header_size - FRAME_DESC_SZ;
mgmt_desc->frame_info |= cpu_to_le16(RATE_INFO_ENABLE);
if (is_broadcast_ether_addr(wh->addr1))
mgmt_desc->frame_info |= cpu_to_le16(RSI_BROADCAST_PKT);
mgmt_desc->seq_ctrl =
cpu_to_le16(IEEE80211_SEQ_TO_SN(le16_to_cpu(wh->seq_ctrl)));
if (common->band == NL80211_BAND_2GHZ)
mgmt_desc->rate_info = RSI_RATE_1;
else
mgmt_desc->rate_info = RSI_RATE_6;
if (conf_is_ht40(conf))
mgmt_desc->bbp_info = cpu_to_le16(FULL40M_ENABLE);
if (ieee80211_is_probe_req(wh->frame_control)) {
if (!bss->assoc) {
rsi_dbg(INFO_ZONE,
"%s: blocking mgmt queue\n", __func__);
mgmt_desc->misc_flags = RSI_DESC_REQUIRE_CFM_TO_HOST;
xtend_desc->confirm_frame_type = PROBEREQ_CONFIRM;
common->mgmt_q_block = true;
rsi_dbg(INFO_ZONE, "Mgmt queue blocked\n");
}
}
if (ieee80211_is_probe_resp(wh->frame_control)) {
mgmt_desc->misc_flags |= (RSI_ADD_DELTA_TSF_VAP_ID |
RSI_FETCH_RETRY_CNT_FRM_HST);
#define PROBE_RESP_RETRY_CNT 3
xtend_desc->retry_cnt = PROBE_RESP_RETRY_CNT;
}
if ((vif->type == NL80211_IFTYPE_AP) &&
(ieee80211_is_action(wh->frame_control))) {
struct rsi_sta *rsta = rsi_find_sta(common, wh->addr1);
if (rsta)
mgmt_desc->sta_id = tx_params->sta_id;
else
return -EINVAL;
}
return 0;
}
/* This function prepares descriptor for given data packet */
static int rsi_prepare_data_desc(struct rsi_common *common, struct sk_buff *skb)
{
struct rsi_hw *adapter = common->priv;
struct ieee80211_vif *vif;
struct ieee80211_hdr *wh = NULL;
struct ieee80211_tx_info *info;
struct skb_info *tx_params;
struct ieee80211_bss_conf *bss;
struct rsi_data_desc *data_desc;
struct xtended_desc *xtend_desc;
u8 ieee80211_size = MIN_802_11_HDR_LEN;
u8 header_size;
u8 vap_id = 0;
u8 dword_align_bytes;
u16 seq_num;
info = IEEE80211_SKB_CB(skb);
bss = &info->control.vif->bss_conf;
tx_params = (struct skb_info *)info->driver_data;
header_size = FRAME_DESC_SZ + sizeof(struct xtended_desc);
if (header_size > skb_headroom(skb)) {
rsi_dbg(ERR_ZONE, "%s: Unable to send pkt\n", __func__);
return -ENOSPC;
}
skb_push(skb, header_size);
dword_align_bytes = ((unsigned long)skb->data & 0x3f);
if (header_size > skb_headroom(skb)) {
rsi_dbg(ERR_ZONE, "%s: Not enough headroom\n", __func__);
return -ENOSPC;
}
skb_push(skb, dword_align_bytes);
header_size += dword_align_bytes;
tx_params->internal_hdr_size = header_size;
data_desc = (struct rsi_data_desc *)skb->data;
memset(data_desc, 0, header_size);
xtend_desc = (struct xtended_desc *)&skb->data[FRAME_DESC_SZ];
wh = (struct ieee80211_hdr *)&skb->data[header_size];
seq_num = IEEE80211_SEQ_TO_SN(le16_to_cpu(wh->seq_ctrl));
vif = adapter->vifs[0];
data_desc->xtend_desc_size = header_size - FRAME_DESC_SZ;
if (ieee80211_is_data_qos(wh->frame_control)) {
ieee80211_size += 2;
data_desc->mac_flags |= cpu_to_le16(RSI_QOS_ENABLE);
}
if ((vif->type == NL80211_IFTYPE_STATION) &&
(adapter->ps_state == PS_ENABLED))
wh->frame_control |= cpu_to_le16(RSI_SET_PS_ENABLE);
if ((!(info->flags & IEEE80211_TX_INTFL_DONT_ENCRYPT)) &&
(common->secinfo.security_enable)) {
if (rsi_is_cipher_wep(common))
ieee80211_size += 4;
else
ieee80211_size += 8;
data_desc->mac_flags |= cpu_to_le16(RSI_ENCRYPT_PKT);
}
rsi_set_len_qno(&data_desc->len_qno, (skb->len - FRAME_DESC_SZ),
RSI_WIFI_DATA_Q);
data_desc->header_len = ieee80211_size;
if (common->min_rate != RSI_RATE_AUTO) {
/* Send fixed rate */
data_desc->frame_info = cpu_to_le16(RATE_INFO_ENABLE);
data_desc->rate_info = cpu_to_le16(common->min_rate);
if (conf_is_ht40(&common->priv->hw->conf))
data_desc->bbp_info = cpu_to_le16(FULL40M_ENABLE);
if ((common->vif_info[0].sgi) && (common->min_rate & 0x100)) {
/* Only MCS rates */
data_desc->rate_info |=
cpu_to_le16(ENABLE_SHORTGI_RATE);
}
}
if (skb->protocol == cpu_to_be16(ETH_P_PAE)) {
rsi_dbg(INFO_ZONE, "*** Tx EAPOL ***\n");
data_desc->frame_info = cpu_to_le16(RATE_INFO_ENABLE);
if (common->band == NL80211_BAND_5GHZ)
data_desc->rate_info = cpu_to_le16(RSI_RATE_6);
else
data_desc->rate_info = cpu_to_le16(RSI_RATE_1);
data_desc->mac_flags |= cpu_to_le16(RSI_REKEY_PURPOSE);
data_desc->misc_flags |= RSI_FETCH_RETRY_CNT_FRM_HST;
#define EAPOL_RETRY_CNT 15
xtend_desc->retry_cnt = EAPOL_RETRY_CNT;
}
data_desc->mac_flags = cpu_to_le16(seq_num & 0xfff);
data_desc->qid_tid = ((skb->priority & 0xf) |
((tx_params->tid & 0xf) << 4));
data_desc->sta_id = tx_params->sta_id;
if ((is_broadcast_ether_addr(wh->addr1)) ||
(is_multicast_ether_addr(wh->addr1))) {
data_desc->frame_info = cpu_to_le16(RATE_INFO_ENABLE);
data_desc->frame_info |= cpu_to_le16(RSI_BROADCAST_PKT);
data_desc->sta_id = vap_id;
if (vif->type == NL80211_IFTYPE_AP) {
if (common->band == NL80211_BAND_5GHZ)
data_desc->rate_info = cpu_to_le16(RSI_RATE_6);
else
data_desc->rate_info = cpu_to_le16(RSI_RATE_1);
}
}
if ((vif->type == NL80211_IFTYPE_AP) &&
(ieee80211_has_moredata(wh->frame_control)))
data_desc->frame_info |= cpu_to_le16(MORE_DATA_PRESENT);
return 0;
}
/* This function sends received data packet from driver to device */
int rsi_send_data_pkt(struct rsi_common *common, struct sk_buff *skb)
{
struct rsi_hw *adapter = common->priv;
struct ieee80211_vif *vif = adapter->vifs[0];
struct ieee80211_tx_info *info;
struct ieee80211_bss_conf *bss;
int status = -EINVAL;
if (!skb)
return 0;
if (common->iface_down)
goto err;
info = IEEE80211_SKB_CB(skb);
if (!info->control.vif)
goto err;
bss = &info->control.vif->bss_conf;
if ((vif->type == NL80211_IFTYPE_STATION) && (!bss->assoc))
goto err;
status = rsi_prepare_data_desc(common, skb);
if (status)
goto err;
status = adapter->host_intf_ops->write_pkt(common->priv, skb->data,
skb->len);
if (status)
rsi_dbg(ERR_ZONE, "%s: Failed to write pkt\n", __func__);
err:
++common->tx_stats.total_tx_pkt_freed[skb->priority];
rsi_indicate_tx_status(adapter, skb, status);
return status;
}
/**
* rsi_send_mgmt_pkt() - This functions sends the received management packet
* from driver to device.
* @common: Pointer to the driver private structure.
* @skb: Pointer to the socket buffer structure.
*
* Return: status: 0 on success, -1 on failure.
*/
int rsi_send_mgmt_pkt(struct rsi_common *common,
struct sk_buff *skb)
{
struct rsi_hw *adapter = common->priv;
struct ieee80211_tx_info *info;
struct skb_info *tx_params;
int status = -E2BIG;
u8 extnd_size;
info = IEEE80211_SKB_CB(skb);
tx_params = (struct skb_info *)info->driver_data;
extnd_size = ((uintptr_t)skb->data & 0x3);
if (tx_params->flags & INTERNAL_MGMT_PKT) {
skb->data[1] |= BIT(7); /* Immediate Wakeup bit*/
if ((extnd_size) > skb_headroom(skb)) {
rsi_dbg(ERR_ZONE, "%s: Unable to send pkt\n", __func__);
dev_kfree_skb(skb);
return -ENOSPC;
}
skb_push(skb, extnd_size);
skb->data[extnd_size + 4] = extnd_size;
status = adapter->host_intf_ops->write_pkt(common->priv,
(u8 *)skb->data,
skb->len);
if (status) {
rsi_dbg(ERR_ZONE,
"%s: Failed to write the packet\n", __func__);
}
dev_kfree_skb(skb);
return status;
}
if (FRAME_DESC_SZ > skb_headroom(skb))
goto err;
rsi_prepare_mgmt_desc(common, skb);
status = adapter->host_intf_ops->write_pkt(common->priv,
(u8 *)skb->data, skb->len);
if (status)
rsi_dbg(ERR_ZONE, "%s: Failed to write the packet\n", __func__);
err:
rsi_indicate_tx_status(common->priv, skb, status);
return status;
}
int rsi_prepare_beacon(struct rsi_common *common, struct sk_buff *skb)
{
struct rsi_hw *adapter = (struct rsi_hw *)common->priv;
struct rsi_data_desc *bcn_frm;
struct ieee80211_hw *hw = common->priv->hw;
struct ieee80211_conf *conf = &hw->conf;
struct sk_buff *mac_bcn;
u8 vap_id = 0;
u16 tim_offset;
mac_bcn = ieee80211_beacon_get_tim(adapter->hw,
adapter->vifs[adapter->sc_nvifs - 1],
&tim_offset, NULL);
if (!mac_bcn) {
rsi_dbg(ERR_ZONE, "Failed to get beacon from mac80211\n");
return -EINVAL;
}
common->beacon_cnt++;
bcn_frm = (struct rsi_data_desc *)skb->data;
rsi_set_len_qno(&bcn_frm->len_qno, mac_bcn->len, RSI_WIFI_DATA_Q);
bcn_frm->header_len = MIN_802_11_HDR_LEN;
bcn_frm->frame_info = cpu_to_le16(RSI_DATA_DESC_MAC_BBP_INFO |
RSI_DATA_DESC_NO_ACK_IND |
RSI_DATA_DESC_BEACON_FRAME |
RSI_DATA_DESC_INSERT_TSF |
RSI_DATA_DESC_INSERT_SEQ_NO |
RATE_INFO_ENABLE);
bcn_frm->rate_info = cpu_to_le16(vap_id << 14);
bcn_frm->qid_tid = BEACON_HW_Q;
if (conf_is_ht40_plus(conf)) {
bcn_frm->bbp_info = cpu_to_le16(LOWER_20_ENABLE);
bcn_frm->bbp_info |= cpu_to_le16(LOWER_20_ENABLE >> 12);
} else if (conf_is_ht40_minus(conf)) {
bcn_frm->bbp_info = cpu_to_le16(UPPER_20_ENABLE);
bcn_frm->bbp_info |= cpu_to_le16(UPPER_20_ENABLE >> 12);
}
if (common->band == NL80211_BAND_2GHZ)
bcn_frm->bbp_info |= cpu_to_le16(RSI_RATE_1);
else
bcn_frm->bbp_info |= cpu_to_le16(RSI_RATE_6);
if (mac_bcn->data[tim_offset + 2] == 0)
bcn_frm->frame_info |= cpu_to_le16(RSI_DATA_DESC_DTIM_BEACON);
memcpy(&skb->data[FRAME_DESC_SZ], mac_bcn->data, mac_bcn->len);
skb_put(skb, mac_bcn->len + FRAME_DESC_SZ);
dev_kfree_skb(mac_bcn);
return 0;
}
static void bl_cmd_timeout(unsigned long priv)
{
struct rsi_hw *adapter = (struct rsi_hw *)priv;
adapter->blcmd_timer_expired = true;
del_timer(&adapter->bl_cmd_timer);
}
static int bl_start_cmd_timer(struct rsi_hw *adapter, u32 timeout)
{
setup_timer(&adapter->bl_cmd_timer, (void *)&bl_cmd_timeout,
(unsigned long)adapter);
adapter->bl_cmd_timer.expires = (msecs_to_jiffies(timeout) + jiffies);
adapter->blcmd_timer_expired = false;
add_timer(&adapter->bl_cmd_timer);
return 0;
}
static int bl_stop_cmd_timer(struct rsi_hw *adapter)
{
adapter->blcmd_timer_expired = false;
if (timer_pending(&adapter->bl_cmd_timer))
del_timer(&adapter->bl_cmd_timer);
return 0;
}
static int bl_write_cmd(struct rsi_hw *adapter, u8 cmd, u8 exp_resp,
u16 *cmd_resp)
{
struct rsi_host_intf_ops *hif_ops = adapter->host_intf_ops;
u32 regin_val = 0, regout_val = 0;
u32 regin_input = 0;
u8 output = 0;
int status;
regin_input = (REGIN_INPUT | adapter->priv->coex_mode);
while (!adapter->blcmd_timer_expired) {
regin_val = 0;
status = hif_ops->master_reg_read(adapter, SWBL_REGIN,
&regin_val, 2);
if (status < 0) {
rsi_dbg(ERR_ZONE,
"%s: Command %0x REGIN reading failed..\n",
__func__, cmd);
return status;
}
mdelay(1);
if ((regin_val >> 12) != REGIN_VALID)
break;
}
if (adapter->blcmd_timer_expired) {
rsi_dbg(ERR_ZONE,
"%s: Command %0x REGIN reading timed out..\n",
__func__, cmd);
return -ETIMEDOUT;
}
rsi_dbg(INFO_ZONE,
"Issuing write to Regin val:%0x sending cmd:%0x\n",
regin_val, (cmd | regin_input << 8));
status = hif_ops->master_reg_write(adapter, SWBL_REGIN,
(cmd | regin_input << 8), 2);
if (status < 0)
return status;
mdelay(1);
if (cmd == LOAD_HOSTED_FW || cmd == JUMP_TO_ZERO_PC) {
/* JUMP_TO_ZERO_PC doesn't expect
* any response. So return from here
*/
return 0;
}
while (!adapter->blcmd_timer_expired) {
regout_val = 0;
status = hif_ops->master_reg_read(adapter, SWBL_REGOUT,
&regout_val, 2);
if (status < 0) {
rsi_dbg(ERR_ZONE,
"%s: Command %0x REGOUT reading failed..\n",
__func__, cmd);
return status;
}
mdelay(1);
if ((regout_val >> 8) == REGOUT_VALID)
break;
}
if (adapter->blcmd_timer_expired) {
rsi_dbg(ERR_ZONE,
"%s: Command %0x REGOUT reading timed out..\n",
__func__, cmd);
return status;
}
*cmd_resp = ((u16 *)&regout_val)[0] & 0xffff;
output = ((u8 *)&regout_val)[0] & 0xff;
status = hif_ops->master_reg_write(adapter, SWBL_REGOUT,
(cmd | REGOUT_INVALID << 8), 2);
if (status < 0) {
rsi_dbg(ERR_ZONE,
"%s: Command %0x REGOUT writing failed..\n",
__func__, cmd);
return status;
}
mdelay(1);
if (output != exp_resp) {
rsi_dbg(ERR_ZONE,
"%s: Recvd resp %x for cmd %0x\n",
__func__, output, cmd);
return -EINVAL;
}
rsi_dbg(INFO_ZONE,
"%s: Recvd Expected resp %x for cmd %0x\n",
__func__, output, cmd);
return 0;
}
static int bl_cmd(struct rsi_hw *adapter, u8 cmd, u8 exp_resp, char *str)
{
u16 regout_val = 0;
u32 timeout;
int status;
if ((cmd == EOF_REACHED) || (cmd == PING_VALID) || (cmd == PONG_VALID))
timeout = BL_BURN_TIMEOUT;
else
timeout = BL_CMD_TIMEOUT;
bl_start_cmd_timer(adapter, timeout);
status = bl_write_cmd(adapter, cmd, exp_resp, &regout_val);
if (status < 0) {
rsi_dbg(ERR_ZONE,
"%s: Command %s (%0x) writing failed..\n",
__func__, str, cmd);
return status;
}
bl_stop_cmd_timer(adapter);
return 0;
}
#define CHECK_SUM_OFFSET 20
#define LEN_OFFSET 8
#define ADDR_OFFSET 16
static int bl_write_header(struct rsi_hw *adapter, u8 *flash_content,
u32 content_size)
{
struct rsi_host_intf_ops *hif_ops = adapter->host_intf_ops;
struct bl_header bl_hdr;
u32 write_addr, write_len;
int status;
bl_hdr.flags = 0;
bl_hdr.image_no = cpu_to_le32(adapter->priv->coex_mode);
bl_hdr.check_sum = cpu_to_le32(
*(u32 *)&flash_content[CHECK_SUM_OFFSET]);
bl_hdr.flash_start_address = cpu_to_le32(
*(u32 *)&flash_content[ADDR_OFFSET]);
bl_hdr.flash_len = cpu_to_le32(*(u32 *)&flash_content[LEN_OFFSET]);
write_len = sizeof(struct bl_header);
if (adapter->rsi_host_intf == RSI_HOST_INTF_USB) {
write_addr = PING_BUFFER_ADDRESS;
status = hif_ops->write_reg_multiple(adapter, write_addr,
(u8 *)&bl_hdr, write_len);
if (status < 0) {
rsi_dbg(ERR_ZONE,
"%s: Failed to load Version/CRC structure\n",
__func__);
return status;
}
} else {
write_addr = PING_BUFFER_ADDRESS >> 16;
status = hif_ops->master_access_msword(adapter, write_addr);
if (status < 0) {
rsi_dbg(ERR_ZONE,
"%s: Unable to set ms word to common reg\n",
__func__);
return status;
}
write_addr = RSI_SD_REQUEST_MASTER |
(PING_BUFFER_ADDRESS & 0xFFFF);
status = hif_ops->write_reg_multiple(adapter, write_addr,
(u8 *)&bl_hdr, write_len);
if (status < 0) {
rsi_dbg(ERR_ZONE,
"%s: Failed to load Version/CRC structure\n",
__func__);
return status;
}
}
return 0;
}
static u32 read_flash_capacity(struct rsi_hw *adapter)
{
u32 flash_sz = 0;
if ((adapter->host_intf_ops->master_reg_read(adapter, FLASH_SIZE_ADDR,
&flash_sz, 2)) < 0) {
rsi_dbg(ERR_ZONE,
"%s: Flash size reading failed..\n",
__func__);
return 0;
}
rsi_dbg(INIT_ZONE, "Flash capacity: %d KiloBytes\n", flash_sz);
return (flash_sz * 1024); /* Return size in kbytes */
}
static int ping_pong_write(struct rsi_hw *adapter, u8 cmd, u8 *addr, u32 size)
{
struct rsi_host_intf_ops *hif_ops = adapter->host_intf_ops;
u32 block_size = adapter->block_size;
u32 cmd_addr;
u16 cmd_resp, cmd_req;
u8 *str;
int status;
if (cmd == PING_WRITE) {
cmd_addr = PING_BUFFER_ADDRESS;
cmd_resp = PONG_AVAIL;
cmd_req = PING_VALID;
str = "PING_VALID";
} else {
cmd_addr = PONG_BUFFER_ADDRESS;
cmd_resp = PING_AVAIL;
cmd_req = PONG_VALID;
str = "PONG_VALID";
}
status = hif_ops->load_data_master_write(adapter, cmd_addr, size,
block_size, addr);
if (status) {
rsi_dbg(ERR_ZONE, "%s: Unable to write blk at addr %0x\n",
__func__, *addr);
return status;
}
status = bl_cmd(adapter, cmd_req, cmd_resp, str);
if (status) {
bl_stop_cmd_timer(adapter);
return status;
}
return 0;
}
static int auto_fw_upgrade(struct rsi_hw *adapter, u8 *flash_content,
u32 content_size)
{
u8 cmd, *temp_flash_content;
u32 temp_content_size, num_flash, index;
u32 flash_start_address;
int status;
temp_flash_content = flash_content;
if (content_size > MAX_FLASH_FILE_SIZE) {
rsi_dbg(ERR_ZONE,
"%s: Flash Content size is more than 400K %u\n",
__func__, MAX_FLASH_FILE_SIZE);
return -EINVAL;
}
flash_start_address = *(u32 *)&flash_content[FLASH_START_ADDRESS];
rsi_dbg(INFO_ZONE, "flash start address: %08x\n", flash_start_address);
if (flash_start_address < FW_IMAGE_MIN_ADDRESS) {
rsi_dbg(ERR_ZONE,
"%s: Fw image Flash Start Address is less than 64K\n",
__func__);
return -EINVAL;
}
if (flash_start_address % FLASH_SECTOR_SIZE) {
rsi_dbg(ERR_ZONE,
"%s: Flash Start Address is not multiple of 4K\n",
__func__);
return -EINVAL;
}
if ((flash_start_address + content_size) > adapter->flash_capacity) {
rsi_dbg(ERR_ZONE,
"%s: Flash Content will cross max flash size\n",
__func__);
return -EINVAL;
}
temp_content_size = content_size;
num_flash = content_size / FLASH_WRITE_CHUNK_SIZE;
rsi_dbg(INFO_ZONE, "content_size: %d, num_flash: %d\n",
content_size, num_flash);
for (index = 0; index <= num_flash; index++) {
rsi_dbg(INFO_ZONE, "flash index: %d\n", index);
if (index != num_flash) {
content_size = FLASH_WRITE_CHUNK_SIZE;
rsi_dbg(INFO_ZONE, "QSPI content_size:%d\n",
content_size);
} else {
content_size =
temp_content_size % FLASH_WRITE_CHUNK_SIZE;
rsi_dbg(INFO_ZONE,
"Writing last sector content_size:%d\n",
content_size);
if (!content_size) {
rsi_dbg(INFO_ZONE, "instruction size zero\n");
break;
}
}
if (index % 2)
cmd = PING_WRITE;
else
cmd = PONG_WRITE;
status = ping_pong_write(adapter, cmd, flash_content,
content_size);
if (status) {
rsi_dbg(ERR_ZONE, "%s: Unable to load %d block\n",
__func__, index);
return status;
}
rsi_dbg(INFO_ZONE,
"%s: Successfully loaded %d instructions\n",
__func__, index);
flash_content += content_size;
}
status = bl_cmd(adapter, EOF_REACHED, FW_LOADING_SUCCESSFUL,
"EOF_REACHED");
if (status) {
bl_stop_cmd_timer(adapter);
return status;
}
rsi_dbg(INFO_ZONE, "FW loading is done and FW is running..\n");
return 0;
}
static int rsi_load_firmware(struct rsi_hw *adapter)
{
struct rsi_host_intf_ops *hif_ops = adapter->host_intf_ops;
const struct firmware *fw_entry = NULL;
u32 regout_val = 0, content_size;
u16 tmp_regout_val = 0;
u8 *flash_content = NULL;
struct ta_metadata *metadata_p;
int status;
bl_start_cmd_timer(adapter, BL_CMD_TIMEOUT);
while (!adapter->blcmd_timer_expired) {
status = hif_ops->master_reg_read(adapter, SWBL_REGOUT,
&regout_val, 2);
if (status < 0) {
rsi_dbg(ERR_ZONE,
"%s: REGOUT read failed\n", __func__);
return status;
}
mdelay(1);
if ((regout_val >> 8) == REGOUT_VALID)
break;
}
if (adapter->blcmd_timer_expired) {
rsi_dbg(ERR_ZONE, "%s: REGOUT read timedout\n", __func__);
rsi_dbg(ERR_ZONE,
"%s: Soft boot loader not present\n", __func__);
return -ETIMEDOUT;
}
bl_stop_cmd_timer(adapter);
rsi_dbg(INFO_ZONE, "Received Board Version Number: %x\n",
(regout_val & 0xff));
status = hif_ops->master_reg_write(adapter, SWBL_REGOUT,
(REGOUT_INVALID | REGOUT_INVALID << 8),
2);
if (status < 0) {
rsi_dbg(ERR_ZONE, "%s: REGOUT writing failed..\n", __func__);
return status;
}
mdelay(1);
status = bl_cmd(adapter, CONFIG_AUTO_READ_MODE, CMD_PASS,
"AUTO_READ_CMD");
if (status < 0)
return status;
adapter->flash_capacity = read_flash_capacity(adapter);
if (adapter->flash_capacity <= 0) {
rsi_dbg(ERR_ZONE,
"%s: Unable to read flash size from EEPROM\n",
__func__);
return -EINVAL;
}
metadata_p = &metadata_flash_content[adapter->priv->coex_mode];
rsi_dbg(INIT_ZONE, "%s: Loading file %s\n", __func__, metadata_p->name);
adapter->fw_file_name = metadata_p->name;
status = request_firmware(&fw_entry, metadata_p->name, adapter->device);
if (status < 0) {
rsi_dbg(ERR_ZONE, "%s: Failed to open file %s\n",
__func__, metadata_p->name);
return status;
}
flash_content = kmemdup(fw_entry->data, fw_entry->size, GFP_KERNEL);
if (!flash_content) {
rsi_dbg(ERR_ZONE, "%s: Failed to copy firmware\n", __func__);
status = -EIO;
goto fail;
}
content_size = fw_entry->size;
rsi_dbg(INFO_ZONE, "FW Length = %d bytes\n", content_size);
status = bl_write_header(adapter, flash_content, content_size);
if (status) {
rsi_dbg(ERR_ZONE,
"%s: RPS Image header loading failed\n",
__func__);
goto fail;
}
bl_start_cmd_timer(adapter, BL_CMD_TIMEOUT);
status = bl_write_cmd(adapter, CHECK_CRC, CMD_PASS, &tmp_regout_val);
if (status) {
bl_stop_cmd_timer(adapter);
rsi_dbg(ERR_ZONE,
"%s: CHECK_CRC Command writing failed..\n",
__func__);
if ((tmp_regout_val & 0xff) == CMD_FAIL) {
rsi_dbg(ERR_ZONE,
"CRC Fail.. Proceeding to Upgrade mode\n");
goto fw_upgrade;
}
}
bl_stop_cmd_timer(adapter);
status = bl_cmd(adapter, POLLING_MODE, CMD_PASS, "POLLING_MODE");
if (status)
goto fail;
load_image_cmd:
status = bl_cmd(adapter, LOAD_HOSTED_FW, LOADING_INITIATED,
"LOAD_HOSTED_FW");
if (status)
goto fail;
rsi_dbg(INFO_ZONE, "Load Image command passed..\n");
goto success;
fw_upgrade:
status = bl_cmd(adapter, BURN_HOSTED_FW, SEND_RPS_FILE, "FW_UPGRADE");
if (status)
goto fail;
rsi_dbg(INFO_ZONE, "Burn Command Pass.. Upgrading the firmware\n");
status = auto_fw_upgrade(adapter, flash_content, content_size);
if (status == 0) {
rsi_dbg(ERR_ZONE, "Firmware upgradation Done\n");
goto load_image_cmd;
}
rsi_dbg(ERR_ZONE, "Firmware upgrade failed\n");
status = bl_cmd(adapter, CONFIG_AUTO_READ_MODE, CMD_PASS,
"AUTO_READ_MODE");
if (status)
goto fail;
success:
rsi_dbg(ERR_ZONE, "***** Firmware Loading successful *****\n");
kfree(flash_content);
release_firmware(fw_entry);
return 0;
fail:
rsi_dbg(ERR_ZONE, "##### Firmware loading failed #####\n");
kfree(flash_content);
release_firmware(fw_entry);
return status;
}
int rsi_hal_device_init(struct rsi_hw *adapter)
{
struct rsi_common *common = adapter->priv;
common->coex_mode = RSI_DEV_COEX_MODE_WIFI_ALONE;
common->oper_mode = RSI_DEV_OPMODE_WIFI_ALONE;
adapter->device_model = RSI_DEV_9113;
switch (adapter->device_model) {
case RSI_DEV_9113:
if (rsi_load_firmware(adapter)) {
rsi_dbg(ERR_ZONE,
"%s: Failed to load TA instructions\n",
__func__);
return -EINVAL;
}
break;
default:
return -EINVAL;
}
common->fsm_state = FSM_CARD_NOT_READY;
return 0;
}
EXPORT_SYMBOL_GPL(rsi_hal_device_init);