forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
245 lines
6.4 KiB
245 lines
6.4 KiB
// SPDX-License-Identifier: GPL-2.0 |
|
/* Copyright(c) 2009-2014 Realtek Corporation.*/ |
|
|
|
#include "../wifi.h" |
|
#include "../pci.h" |
|
#include "../base.h" |
|
#include "../efuse.h" |
|
#include "fw_common.h" |
|
#include <linux/module.h> |
|
|
|
void rtl8723_enable_fw_download(struct ieee80211_hw *hw, bool enable) |
|
{ |
|
struct rtl_priv *rtlpriv = rtl_priv(hw); |
|
u8 tmp; |
|
|
|
if (enable) { |
|
tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1); |
|
rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1, |
|
tmp | 0x04); |
|
|
|
tmp = rtl_read_byte(rtlpriv, REG_MCUFWDL); |
|
rtl_write_byte(rtlpriv, REG_MCUFWDL, tmp | 0x01); |
|
|
|
tmp = rtl_read_byte(rtlpriv, REG_MCUFWDL + 2); |
|
rtl_write_byte(rtlpriv, REG_MCUFWDL + 2, tmp & 0xf7); |
|
} else { |
|
tmp = rtl_read_byte(rtlpriv, REG_MCUFWDL); |
|
rtl_write_byte(rtlpriv, REG_MCUFWDL, tmp & 0xfe); |
|
|
|
rtl_write_byte(rtlpriv, REG_MCUFWDL + 1, 0x00); |
|
} |
|
} |
|
EXPORT_SYMBOL_GPL(rtl8723_enable_fw_download); |
|
|
|
void rtl8723_write_fw(struct ieee80211_hw *hw, |
|
enum version_8723e version, |
|
u8 *buffer, u32 size, u8 max_page) |
|
{ |
|
struct rtl_priv *rtlpriv = rtl_priv(hw); |
|
u8 *bufferptr = buffer; |
|
u32 page_nums, remain_size; |
|
u32 page, offset; |
|
|
|
rtl_dbg(rtlpriv, COMP_FW, DBG_TRACE, "FW size is %d bytes,\n", size); |
|
|
|
rtl_fill_dummy(bufferptr, &size); |
|
|
|
page_nums = size / FW_8192C_PAGE_SIZE; |
|
remain_size = size % FW_8192C_PAGE_SIZE; |
|
|
|
if (page_nums > max_page) { |
|
pr_err("Page numbers should not greater than %d\n", |
|
max_page); |
|
} |
|
for (page = 0; page < page_nums; page++) { |
|
offset = page * FW_8192C_PAGE_SIZE; |
|
rtl_fw_page_write(hw, page, (bufferptr + offset), |
|
FW_8192C_PAGE_SIZE); |
|
} |
|
|
|
if (remain_size) { |
|
offset = page_nums * FW_8192C_PAGE_SIZE; |
|
page = page_nums; |
|
rtl_fw_page_write(hw, page, (bufferptr + offset), remain_size); |
|
} |
|
rtl_dbg(rtlpriv, COMP_FW, DBG_TRACE, "FW write done.\n"); |
|
} |
|
EXPORT_SYMBOL_GPL(rtl8723_write_fw); |
|
|
|
void rtl8723ae_firmware_selfreset(struct ieee80211_hw *hw) |
|
{ |
|
u8 u1b_tmp; |
|
u8 delay = 100; |
|
struct rtl_priv *rtlpriv = rtl_priv(hw); |
|
|
|
rtl_write_byte(rtlpriv, REG_HMETFR + 3, 0x20); |
|
u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1); |
|
|
|
while (u1b_tmp & BIT(2)) { |
|
delay--; |
|
if (delay == 0) |
|
break; |
|
udelay(50); |
|
u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1); |
|
} |
|
if (delay == 0) { |
|
u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1); |
|
rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1, |
|
u1b_tmp&(~BIT(2))); |
|
} |
|
} |
|
EXPORT_SYMBOL_GPL(rtl8723ae_firmware_selfreset); |
|
|
|
void rtl8723be_firmware_selfreset(struct ieee80211_hw *hw) |
|
{ |
|
u8 u1b_tmp; |
|
struct rtl_priv *rtlpriv = rtl_priv(hw); |
|
|
|
u1b_tmp = rtl_read_byte(rtlpriv, REG_RSV_CTRL + 1); |
|
rtl_write_byte(rtlpriv, REG_RSV_CTRL + 1, (u1b_tmp & (~BIT(0)))); |
|
|
|
u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1); |
|
rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1, (u1b_tmp & (~BIT(2)))); |
|
udelay(50); |
|
|
|
u1b_tmp = rtl_read_byte(rtlpriv, REG_RSV_CTRL + 1); |
|
rtl_write_byte(rtlpriv, REG_RSV_CTRL + 1, (u1b_tmp | BIT(0))); |
|
|
|
u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1); |
|
rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1, (u1b_tmp | BIT(2))); |
|
|
|
rtl_dbg(rtlpriv, COMP_INIT, DBG_LOUD, |
|
"_8051Reset8723be(): 8051 reset success .\n"); |
|
} |
|
EXPORT_SYMBOL_GPL(rtl8723be_firmware_selfreset); |
|
|
|
int rtl8723_fw_free_to_go(struct ieee80211_hw *hw, bool is_8723be, |
|
int max_count) |
|
{ |
|
struct rtl_priv *rtlpriv = rtl_priv(hw); |
|
int err = -EIO; |
|
u32 counter = 0; |
|
u32 value32; |
|
|
|
do { |
|
value32 = rtl_read_dword(rtlpriv, REG_MCUFWDL); |
|
} while ((counter++ < max_count) && |
|
(!(value32 & FWDL_CHKSUM_RPT))); |
|
|
|
if (counter >= max_count) { |
|
pr_err("chksum report fail ! REG_MCUFWDL:0x%08x .\n", |
|
value32); |
|
goto exit; |
|
} |
|
value32 = rtl_read_dword(rtlpriv, REG_MCUFWDL) | MCUFWDL_RDY; |
|
value32 &= ~WINTINI_RDY; |
|
rtl_write_dword(rtlpriv, REG_MCUFWDL, value32); |
|
|
|
if (is_8723be) |
|
rtl8723be_firmware_selfreset(hw); |
|
counter = 0; |
|
|
|
do { |
|
value32 = rtl_read_dword(rtlpriv, REG_MCUFWDL); |
|
if (value32 & WINTINI_RDY) { |
|
rtl_dbg(rtlpriv, COMP_FW, DBG_TRACE, |
|
"Polling FW ready success!! REG_MCUFWDL:0x%08x .\n", |
|
value32); |
|
err = 0; |
|
goto exit; |
|
} |
|
|
|
mdelay(FW_8192C_POLLING_DELAY); |
|
|
|
} while (counter++ < max_count); |
|
|
|
pr_err("Polling FW ready fail!! REG_MCUFWDL:0x%08x .\n", |
|
value32); |
|
|
|
exit: |
|
return err; |
|
} |
|
EXPORT_SYMBOL_GPL(rtl8723_fw_free_to_go); |
|
|
|
int rtl8723_download_fw(struct ieee80211_hw *hw, |
|
bool is_8723be, int max_count) |
|
{ |
|
struct rtl_priv *rtlpriv = rtl_priv(hw); |
|
struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); |
|
struct rtlwifi_firmware_header *pfwheader; |
|
u8 *pfwdata; |
|
u32 fwsize; |
|
int err; |
|
enum version_8723e version = rtlhal->version; |
|
int max_page; |
|
|
|
if (rtlpriv->max_fw_size == 0 || !rtlhal->pfirmware) |
|
return 1; |
|
|
|
pfwheader = (struct rtlwifi_firmware_header *)rtlhal->pfirmware; |
|
rtlhal->fw_version = le16_to_cpu(pfwheader->version); |
|
rtlhal->fw_subversion = pfwheader->subversion; |
|
pfwdata = rtlhal->pfirmware; |
|
fwsize = rtlhal->fwsize; |
|
|
|
if (!is_8723be) |
|
max_page = 6; |
|
else |
|
max_page = 8; |
|
if (rtlpriv->cfg->ops->is_fw_header(pfwheader)) { |
|
rtl_dbg(rtlpriv, COMP_FW, DBG_LOUD, |
|
"Firmware Version(%d), Signature(%#x), Size(%d)\n", |
|
pfwheader->version, pfwheader->signature, |
|
(int)sizeof(struct rtlwifi_firmware_header)); |
|
|
|
pfwdata = pfwdata + sizeof(struct rtlwifi_firmware_header); |
|
fwsize = fwsize - sizeof(struct rtlwifi_firmware_header); |
|
} |
|
|
|
if (rtl_read_byte(rtlpriv, REG_MCUFWDL)&BIT(7)) { |
|
if (is_8723be) |
|
rtl8723be_firmware_selfreset(hw); |
|
else |
|
rtl8723ae_firmware_selfreset(hw); |
|
rtl_write_byte(rtlpriv, REG_MCUFWDL, 0x00); |
|
} |
|
rtl8723_enable_fw_download(hw, true); |
|
rtl8723_write_fw(hw, version, pfwdata, fwsize, max_page); |
|
rtl8723_enable_fw_download(hw, false); |
|
|
|
err = rtl8723_fw_free_to_go(hw, is_8723be, max_count); |
|
if (err) |
|
pr_err("Firmware is not ready to run!\n"); |
|
return 0; |
|
} |
|
EXPORT_SYMBOL_GPL(rtl8723_download_fw); |
|
|
|
bool rtl8723_cmd_send_packet(struct ieee80211_hw *hw, |
|
struct sk_buff *skb) |
|
{ |
|
struct rtl_priv *rtlpriv = rtl_priv(hw); |
|
struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); |
|
struct rtl8192_tx_ring *ring; |
|
struct rtl_tx_desc *pdesc; |
|
struct sk_buff *pskb = NULL; |
|
unsigned long flags; |
|
|
|
ring = &rtlpci->tx_ring[BEACON_QUEUE]; |
|
|
|
pskb = __skb_dequeue(&ring->queue); |
|
kfree_skb(pskb); |
|
spin_lock_irqsave(&rtlpriv->locks.irq_th_lock, flags); |
|
|
|
pdesc = &ring->desc[0]; |
|
rtlpriv->cfg->ops->fill_tx_cmddesc(hw, (u8 *)pdesc, 1, 1, skb); |
|
|
|
__skb_queue_tail(&ring->queue, skb); |
|
|
|
spin_unlock_irqrestore(&rtlpriv->locks.irq_th_lock, flags); |
|
|
|
rtlpriv->cfg->ops->tx_polling(hw, BEACON_QUEUE); |
|
|
|
return true; |
|
} |
|
EXPORT_SYMBOL_GPL(rtl8723_cmd_send_packet);
|
|
|