1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 2009-2014 Realtek Corporation.*/
3
4 #include "../wifi.h"
5 #include "../pci.h"
6 #include "../base.h"
7 #include "../efuse.h"
8 #include "fw_common.h"
9 #include <linux/module.h>
10
rtl8723_enable_fw_download(struct ieee80211_hw * hw,bool enable)11 void rtl8723_enable_fw_download(struct ieee80211_hw *hw, bool enable)
12 {
13 struct rtl_priv *rtlpriv = rtl_priv(hw);
14 u8 tmp;
15
16 if (enable) {
17 tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
18 rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1,
19 tmp | 0x04);
20
21 tmp = rtl_read_byte(rtlpriv, REG_MCUFWDL);
22 rtl_write_byte(rtlpriv, REG_MCUFWDL, tmp | 0x01);
23
24 tmp = rtl_read_byte(rtlpriv, REG_MCUFWDL + 2);
25 rtl_write_byte(rtlpriv, REG_MCUFWDL + 2, tmp & 0xf7);
26 } else {
27 tmp = rtl_read_byte(rtlpriv, REG_MCUFWDL);
28 rtl_write_byte(rtlpriv, REG_MCUFWDL, tmp & 0xfe);
29
30 rtl_write_byte(rtlpriv, REG_MCUFWDL + 1, 0x00);
31 }
32 }
33 EXPORT_SYMBOL_GPL(rtl8723_enable_fw_download);
34
rtl8723_write_fw(struct ieee80211_hw * hw,enum version_8723e version,u8 * buffer,u32 size,u8 max_page)35 void rtl8723_write_fw(struct ieee80211_hw *hw,
36 enum version_8723e version,
37 u8 *buffer, u32 size, u8 max_page)
38 {
39 struct rtl_priv *rtlpriv = rtl_priv(hw);
40 u8 *bufferptr = buffer;
41 u32 page_nums, remain_size;
42 u32 page, offset;
43
44 rtl_dbg(rtlpriv, COMP_FW, DBG_TRACE, "FW size is %d bytes,\n", size);
45
46 rtl_fill_dummy(bufferptr, &size);
47
48 page_nums = size / FW_8192C_PAGE_SIZE;
49 remain_size = size % FW_8192C_PAGE_SIZE;
50
51 if (page_nums > max_page) {
52 pr_err("Page numbers should not greater than %d\n",
53 max_page);
54 }
55 for (page = 0; page < page_nums; page++) {
56 offset = page * FW_8192C_PAGE_SIZE;
57 rtl_fw_page_write(hw, page, (bufferptr + offset),
58 FW_8192C_PAGE_SIZE);
59 }
60
61 if (remain_size) {
62 offset = page_nums * FW_8192C_PAGE_SIZE;
63 page = page_nums;
64 rtl_fw_page_write(hw, page, (bufferptr + offset), remain_size);
65 }
66 rtl_dbg(rtlpriv, COMP_FW, DBG_TRACE, "FW write done.\n");
67 }
68 EXPORT_SYMBOL_GPL(rtl8723_write_fw);
69
rtl8723ae_firmware_selfreset(struct ieee80211_hw * hw)70 void rtl8723ae_firmware_selfreset(struct ieee80211_hw *hw)
71 {
72 u8 u1b_tmp;
73 u8 delay = 100;
74 struct rtl_priv *rtlpriv = rtl_priv(hw);
75
76 rtl_write_byte(rtlpriv, REG_HMETFR + 3, 0x20);
77 u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
78
79 while (u1b_tmp & BIT(2)) {
80 delay--;
81 if (delay == 0)
82 break;
83 udelay(50);
84 u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
85 }
86 if (delay == 0) {
87 u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
88 rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1,
89 u1b_tmp&(~BIT(2)));
90 }
91 }
92 EXPORT_SYMBOL_GPL(rtl8723ae_firmware_selfreset);
93
rtl8723be_firmware_selfreset(struct ieee80211_hw * hw)94 void rtl8723be_firmware_selfreset(struct ieee80211_hw *hw)
95 {
96 u8 u1b_tmp;
97 struct rtl_priv *rtlpriv = rtl_priv(hw);
98
99 u1b_tmp = rtl_read_byte(rtlpriv, REG_RSV_CTRL + 1);
100 rtl_write_byte(rtlpriv, REG_RSV_CTRL + 1, (u1b_tmp & (~BIT(0))));
101
102 u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
103 rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1, (u1b_tmp & (~BIT(2))));
104 udelay(50);
105
106 u1b_tmp = rtl_read_byte(rtlpriv, REG_RSV_CTRL + 1);
107 rtl_write_byte(rtlpriv, REG_RSV_CTRL + 1, (u1b_tmp | BIT(0)));
108
109 u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
110 rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1, (u1b_tmp | BIT(2)));
111
112 rtl_dbg(rtlpriv, COMP_INIT, DBG_LOUD,
113 "_8051Reset8723be(): 8051 reset success .\n");
114 }
115 EXPORT_SYMBOL_GPL(rtl8723be_firmware_selfreset);
116
rtl8723_fw_free_to_go(struct ieee80211_hw * hw,bool is_8723be,int max_count)117 int rtl8723_fw_free_to_go(struct ieee80211_hw *hw, bool is_8723be,
118 int max_count)
119 {
120 struct rtl_priv *rtlpriv = rtl_priv(hw);
121 int err = -EIO;
122 u32 counter = 0;
123 u32 value32;
124
125 do {
126 value32 = rtl_read_dword(rtlpriv, REG_MCUFWDL);
127 } while ((counter++ < max_count) &&
128 (!(value32 & FWDL_CHKSUM_RPT)));
129
130 if (counter >= max_count) {
131 pr_err("chksum report fail ! REG_MCUFWDL:0x%08x .\n",
132 value32);
133 goto exit;
134 }
135 value32 = rtl_read_dword(rtlpriv, REG_MCUFWDL) | MCUFWDL_RDY;
136 value32 &= ~WINTINI_RDY;
137 rtl_write_dword(rtlpriv, REG_MCUFWDL, value32);
138
139 if (is_8723be)
140 rtl8723be_firmware_selfreset(hw);
141 counter = 0;
142
143 do {
144 value32 = rtl_read_dword(rtlpriv, REG_MCUFWDL);
145 if (value32 & WINTINI_RDY) {
146 rtl_dbg(rtlpriv, COMP_FW, DBG_TRACE,
147 "Polling FW ready success!! REG_MCUFWDL:0x%08x .\n",
148 value32);
149 err = 0;
150 goto exit;
151 }
152
153 mdelay(FW_8192C_POLLING_DELAY);
154
155 } while (counter++ < max_count);
156
157 pr_err("Polling FW ready fail!! REG_MCUFWDL:0x%08x .\n",
158 value32);
159
160 exit:
161 return err;
162 }
163 EXPORT_SYMBOL_GPL(rtl8723_fw_free_to_go);
164
rtl8723_download_fw(struct ieee80211_hw * hw,bool is_8723be,int max_count)165 int rtl8723_download_fw(struct ieee80211_hw *hw,
166 bool is_8723be, int max_count)
167 {
168 struct rtl_priv *rtlpriv = rtl_priv(hw);
169 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
170 struct rtlwifi_firmware_header *pfwheader;
171 u8 *pfwdata;
172 u32 fwsize;
173 int err;
174 enum version_8723e version = rtlhal->version;
175 int max_page;
176
177 if (rtlpriv->max_fw_size == 0 || !rtlhal->pfirmware)
178 return 1;
179
180 pfwheader = (struct rtlwifi_firmware_header *)rtlhal->pfirmware;
181 rtlhal->fw_version = le16_to_cpu(pfwheader->version);
182 rtlhal->fw_subversion = pfwheader->subversion;
183 pfwdata = rtlhal->pfirmware;
184 fwsize = rtlhal->fwsize;
185
186 if (!is_8723be)
187 max_page = 6;
188 else
189 max_page = 8;
190 if (rtlpriv->cfg->ops->is_fw_header(pfwheader)) {
191 rtl_dbg(rtlpriv, COMP_FW, DBG_LOUD,
192 "Firmware Version(%d), Signature(%#x), Size(%d)\n",
193 pfwheader->version, pfwheader->signature,
194 (int)sizeof(struct rtlwifi_firmware_header));
195
196 pfwdata = pfwdata + sizeof(struct rtlwifi_firmware_header);
197 fwsize = fwsize - sizeof(struct rtlwifi_firmware_header);
198 }
199
200 if (rtl_read_byte(rtlpriv, REG_MCUFWDL)&BIT(7)) {
201 if (is_8723be)
202 rtl8723be_firmware_selfreset(hw);
203 else
204 rtl8723ae_firmware_selfreset(hw);
205 rtl_write_byte(rtlpriv, REG_MCUFWDL, 0x00);
206 }
207 rtl8723_enable_fw_download(hw, true);
208 rtl8723_write_fw(hw, version, pfwdata, fwsize, max_page);
209 rtl8723_enable_fw_download(hw, false);
210
211 err = rtl8723_fw_free_to_go(hw, is_8723be, max_count);
212 if (err)
213 pr_err("Firmware is not ready to run!\n");
214 return 0;
215 }
216 EXPORT_SYMBOL_GPL(rtl8723_download_fw);
217
rtl8723_cmd_send_packet(struct ieee80211_hw * hw,struct sk_buff * skb)218 bool rtl8723_cmd_send_packet(struct ieee80211_hw *hw,
219 struct sk_buff *skb)
220 {
221 struct rtl_priv *rtlpriv = rtl_priv(hw);
222 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
223 struct rtl8192_tx_ring *ring;
224 struct rtl_tx_desc *pdesc;
225 struct sk_buff *pskb = NULL;
226 unsigned long flags;
227
228 ring = &rtlpci->tx_ring[BEACON_QUEUE];
229
230 pskb = __skb_dequeue(&ring->queue);
231 kfree_skb(pskb);
232 spin_lock_irqsave(&rtlpriv->locks.irq_th_lock, flags);
233
234 pdesc = &ring->desc[0];
235 rtlpriv->cfg->ops->fill_tx_cmddesc(hw, (u8 *)pdesc, 1, 1, skb);
236
237 __skb_queue_tail(&ring->queue, skb);
238
239 spin_unlock_irqrestore(&rtlpriv->locks.irq_th_lock, flags);
240
241 rtlpriv->cfg->ops->tx_polling(hw, BEACON_QUEUE);
242
243 return true;
244 }
245 EXPORT_SYMBOL_GPL(rtl8723_cmd_send_packet);
246