Linux Audio

Check our new training course

Loading...
v4.17
  1/******************************************************************************
  2 *
  3 * Copyright(c) 2009-2014  Realtek Corporation.
  4 *
  5 * This program is free software; you can redistribute it and/or modify it
  6 * under the terms of version 2 of the GNU General Public License as
  7 * published by the Free Software Foundation.
  8 *
  9 * This program is distributed in the hope that it will be useful, but WITHOUT
 10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 11 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 12 * more details.
 13 *
 14 * The full GNU General Public License is included in this distribution in the
 15 * file called LICENSE.
 16 *
 17 * Contact Information:
 18 * wlanfae <wlanfae@realtek.com>
 19 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
 20 * Hsinchu 300, Taiwan.
 21 *
 22 * Larry Finger <Larry.Finger@lwfinger.net>
 23 *
 24 *****************************************************************************/
 25
 26#include "../wifi.h"
 27#include "../pci.h"
 28#include "../base.h"
 29#include "../efuse.h"
 30#include "fw_common.h"
 31#include <linux/module.h>
 32
 33void rtl8723_enable_fw_download(struct ieee80211_hw *hw, bool enable)
 34{
 35	struct rtl_priv *rtlpriv = rtl_priv(hw);
 36	u8 tmp;
 37
 38	if (enable) {
 39		tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
 40		rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1,
 41			       tmp | 0x04);
 42
 43		tmp = rtl_read_byte(rtlpriv, REG_MCUFWDL);
 44		rtl_write_byte(rtlpriv, REG_MCUFWDL, tmp | 0x01);
 45
 46		tmp = rtl_read_byte(rtlpriv, REG_MCUFWDL + 2);
 47		rtl_write_byte(rtlpriv, REG_MCUFWDL + 2, tmp & 0xf7);
 48	} else {
 49		tmp = rtl_read_byte(rtlpriv, REG_MCUFWDL);
 50		rtl_write_byte(rtlpriv, REG_MCUFWDL, tmp & 0xfe);
 51
 52		rtl_write_byte(rtlpriv, REG_MCUFWDL + 1, 0x00);
 53	}
 54}
 55EXPORT_SYMBOL_GPL(rtl8723_enable_fw_download);
 56
 57void rtl8723_write_fw(struct ieee80211_hw *hw,
 58		      enum version_8723e version,
 59		      u8 *buffer, u32 size, u8 max_page)
 60{
 61	struct rtl_priv *rtlpriv = rtl_priv(hw);
 62	u8 *bufferptr = buffer;
 63	u32 page_nums, remain_size;
 64	u32 page, offset;
 65
 66	RT_TRACE(rtlpriv, COMP_FW, DBG_TRACE, "FW size is %d bytes,\n", size);
 67
 68	rtl_fill_dummy(bufferptr, &size);
 69
 70	page_nums = size / FW_8192C_PAGE_SIZE;
 71	remain_size = size % FW_8192C_PAGE_SIZE;
 72
 73	if (page_nums > max_page) {
 74		pr_err("Page numbers should not greater than %d\n",
 75		       max_page);
 76	}
 77	for (page = 0; page < page_nums; page++) {
 78		offset = page * FW_8192C_PAGE_SIZE;
 79		rtl_fw_page_write(hw, page, (bufferptr + offset),
 80				  FW_8192C_PAGE_SIZE);
 81	}
 82
 83	if (remain_size) {
 84		offset = page_nums * FW_8192C_PAGE_SIZE;
 85		page = page_nums;
 86		rtl_fw_page_write(hw, page, (bufferptr + offset), remain_size);
 87	}
 88	RT_TRACE(rtlpriv, COMP_FW, DBG_TRACE, "FW write done.\n");
 89}
 90EXPORT_SYMBOL_GPL(rtl8723_write_fw);
 91
 92void rtl8723ae_firmware_selfreset(struct ieee80211_hw *hw)
 93{
 94	u8 u1b_tmp;
 95	u8 delay = 100;
 96	struct rtl_priv *rtlpriv = rtl_priv(hw);
 97
 98	rtl_write_byte(rtlpriv, REG_HMETFR + 3, 0x20);
 99	u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
100
101	while (u1b_tmp & BIT(2)) {
102		delay--;
103		if (delay == 0)
104			break;
105		udelay(50);
106		u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
107	}
108	if (delay == 0) {
109		u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
110		rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1,
111			       u1b_tmp&(~BIT(2)));
112	}
113}
114EXPORT_SYMBOL_GPL(rtl8723ae_firmware_selfreset);
115
116void rtl8723be_firmware_selfreset(struct ieee80211_hw *hw)
117{
118	u8 u1b_tmp;
119	struct rtl_priv *rtlpriv = rtl_priv(hw);
120
121	u1b_tmp = rtl_read_byte(rtlpriv, REG_RSV_CTRL + 1);
122	rtl_write_byte(rtlpriv, REG_RSV_CTRL + 1, (u1b_tmp & (~BIT(0))));
123
124	u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
125	rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1, (u1b_tmp & (~BIT(2))));
126	udelay(50);
127
128	u1b_tmp = rtl_read_byte(rtlpriv, REG_RSV_CTRL + 1);
129	rtl_write_byte(rtlpriv, REG_RSV_CTRL + 1, (u1b_tmp | BIT(0)));
130
131	u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
132	rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1, (u1b_tmp | BIT(2)));
133
134	RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
135		 "  _8051Reset8723be(): 8051 reset success .\n");
136}
137EXPORT_SYMBOL_GPL(rtl8723be_firmware_selfreset);
138
139int rtl8723_fw_free_to_go(struct ieee80211_hw *hw, bool is_8723be,
140			  int max_count)
141{
142	struct rtl_priv *rtlpriv = rtl_priv(hw);
143	int err = -EIO;
144	u32 counter = 0;
145	u32 value32;
146
147	do {
148		value32 = rtl_read_dword(rtlpriv, REG_MCUFWDL);
149	} while ((counter++ < max_count) &&
150		 (!(value32 & FWDL_CHKSUM_RPT)));
151
152	if (counter >= max_count) {
153		pr_err("chksum report fail ! REG_MCUFWDL:0x%08x .\n",
154		       value32);
155		goto exit;
156	}
157	value32 = rtl_read_dword(rtlpriv, REG_MCUFWDL) | MCUFWDL_RDY;
158	value32 &= ~WINTINI_RDY;
159	rtl_write_dword(rtlpriv, REG_MCUFWDL, value32);
160
161	if (is_8723be)
162		rtl8723be_firmware_selfreset(hw);
163	counter = 0;
164
165	do {
166		value32 = rtl_read_dword(rtlpriv, REG_MCUFWDL);
167		if (value32 & WINTINI_RDY) {
168			RT_TRACE(rtlpriv, COMP_FW, DBG_TRACE,
169				 "Polling FW ready success!! REG_MCUFWDL:0x%08x .\n",
170				 value32);
171			err = 0;
172			goto exit;
173		}
174
175		mdelay(FW_8192C_POLLING_DELAY);
176
177	} while (counter++ < max_count);
178
179	pr_err("Polling FW ready fail!! REG_MCUFWDL:0x%08x .\n",
180	       value32);
181
182exit:
183	return err;
184}
185EXPORT_SYMBOL_GPL(rtl8723_fw_free_to_go);
186
187int rtl8723_download_fw(struct ieee80211_hw *hw,
188			bool is_8723be, int max_count)
189{
190	struct rtl_priv *rtlpriv = rtl_priv(hw);
191	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
192	struct rtlwifi_firmware_header *pfwheader;
193	u8 *pfwdata;
194	u32 fwsize;
195	int err;
196	enum version_8723e version = rtlhal->version;
197	int max_page;
198
199	if (rtlpriv->max_fw_size == 0 || !rtlhal->pfirmware)
200		return 1;
201
202	pfwheader = (struct rtlwifi_firmware_header *)rtlhal->pfirmware;
203	rtlhal->fw_version = le16_to_cpu(pfwheader->version);
204	rtlhal->fw_subversion = pfwheader->subversion;
205	pfwdata = rtlhal->pfirmware;
206	fwsize = rtlhal->fwsize;
207
208	if (!is_8723be)
209		max_page = 6;
210	else
211		max_page = 8;
212	if (rtlpriv->cfg->ops->is_fw_header(pfwheader)) {
213		RT_TRACE(rtlpriv, COMP_FW, DBG_LOUD,
214			 "Firmware Version(%d), Signature(%#x), Size(%d)\n",
215			 pfwheader->version, pfwheader->signature,
216			 (int)sizeof(struct rtlwifi_firmware_header));
217
218		pfwdata = pfwdata + sizeof(struct rtlwifi_firmware_header);
219		fwsize = fwsize - sizeof(struct rtlwifi_firmware_header);
220	}
221
222	if (rtl_read_byte(rtlpriv, REG_MCUFWDL)&BIT(7)) {
223		if (is_8723be)
224			rtl8723be_firmware_selfreset(hw);
225		else
226			rtl8723ae_firmware_selfreset(hw);
227		rtl_write_byte(rtlpriv, REG_MCUFWDL, 0x00);
228	}
229	rtl8723_enable_fw_download(hw, true);
230	rtl8723_write_fw(hw, version, pfwdata, fwsize, max_page);
231	rtl8723_enable_fw_download(hw, false);
232
233	err = rtl8723_fw_free_to_go(hw, is_8723be, max_count);
234	if (err)
235		pr_err("Firmware is not ready to run!\n");
236	return 0;
237}
238EXPORT_SYMBOL_GPL(rtl8723_download_fw);
239
240bool rtl8723_cmd_send_packet(struct ieee80211_hw *hw,
241			     struct sk_buff *skb)
242{
243	struct rtl_priv *rtlpriv = rtl_priv(hw);
244	struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
245	struct rtl8192_tx_ring *ring;
246	struct rtl_tx_desc *pdesc;
247	struct sk_buff *pskb = NULL;
248	u8 own;
249	unsigned long flags;
250
251	ring = &rtlpci->tx_ring[BEACON_QUEUE];
252
253	pskb = __skb_dequeue(&ring->queue);
254	kfree_skb(pskb);
255	spin_lock_irqsave(&rtlpriv->locks.irq_th_lock, flags);
256
257	pdesc = &ring->desc[0];
258	own = (u8)rtlpriv->cfg->ops->get_desc(hw, (u8 *)pdesc, true,
259					      HW_DESC_OWN);
260
261	rtlpriv->cfg->ops->fill_tx_cmddesc(hw, (u8 *)pdesc, 1, 1, skb);
262
263	__skb_queue_tail(&ring->queue, skb);
264
265	spin_unlock_irqrestore(&rtlpriv->locks.irq_th_lock, flags);
266
267	rtlpriv->cfg->ops->tx_polling(hw, BEACON_QUEUE);
268
269	return true;
270}
271EXPORT_SYMBOL_GPL(rtl8723_cmd_send_packet);
v6.13.7
  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
 11void 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}
 33EXPORT_SYMBOL_GPL(rtl8723_enable_fw_download);
 34
 35void 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}
 68EXPORT_SYMBOL_GPL(rtl8723_write_fw);
 69
 70void 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}
 92EXPORT_SYMBOL_GPL(rtl8723ae_firmware_selfreset);
 93
 94void 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}
115EXPORT_SYMBOL_GPL(rtl8723be_firmware_selfreset);
116
117int 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
160exit:
161	return err;
162}
163EXPORT_SYMBOL_GPL(rtl8723_fw_free_to_go);
164
165int 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}
216EXPORT_SYMBOL_GPL(rtl8723_download_fw);
217