]> git.karo-electronics.de Git - karo-tx-linux.git/blob - drivers/net/wireless/realtek/rtl8xxxu/rtl8xxxu.c
rtl8xxxu: Name RX descriptor types rxdesc16/rxdesc24
[karo-tx-linux.git] / drivers / net / wireless / realtek / rtl8xxxu / rtl8xxxu.c
1 /*
2  * RTL8XXXU mac80211 USB driver
3  *
4  * Copyright (c) 2014 - 2015 Jes Sorensen <Jes.Sorensen@redhat.com>
5  *
6  * Portions, notably calibration code:
7  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
8  *
9  * This driver was written as a replacement for the vendor provided
10  * rtl8723au driver. As the Realtek 8xxx chips are very similar in
11  * their programming interface, I have started adding support for
12  * additional 8xxx chips like the 8192cu, 8188cus, etc.
13  *
14  * This program is free software; you can redistribute it and/or modify it
15  * under the terms of version 2 of the GNU General Public License as
16  * published by the Free Software Foundation.
17  *
18  * This program is distributed in the hope that it will be useful, but WITHOUT
19  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
20  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
21  * more details.
22  */
23
24 #include <linux/init.h>
25 #include <linux/kernel.h>
26 #include <linux/sched.h>
27 #include <linux/errno.h>
28 #include <linux/slab.h>
29 #include <linux/module.h>
30 #include <linux/spinlock.h>
31 #include <linux/list.h>
32 #include <linux/usb.h>
33 #include <linux/netdevice.h>
34 #include <linux/etherdevice.h>
35 #include <linux/ethtool.h>
36 #include <linux/wireless.h>
37 #include <linux/firmware.h>
38 #include <linux/moduleparam.h>
39 #include <net/mac80211.h>
40 #include "rtl8xxxu.h"
41 #include "rtl8xxxu_regs.h"
42
43 #define DRIVER_NAME "rtl8xxxu"
44
45 static int rtl8xxxu_debug = RTL8XXXU_DEBUG_EFUSE;
46 static bool rtl8xxxu_ht40_2g;
47
48 MODULE_AUTHOR("Jes Sorensen <Jes.Sorensen@redhat.com>");
49 MODULE_DESCRIPTION("RTL8XXXu USB mac80211 Wireless LAN Driver");
50 MODULE_LICENSE("GPL");
51 MODULE_FIRMWARE("rtlwifi/rtl8723aufw_A.bin");
52 MODULE_FIRMWARE("rtlwifi/rtl8723aufw_B.bin");
53 MODULE_FIRMWARE("rtlwifi/rtl8723aufw_B_NoBT.bin");
54 MODULE_FIRMWARE("rtlwifi/rtl8192cufw_A.bin");
55 MODULE_FIRMWARE("rtlwifi/rtl8192cufw_B.bin");
56 MODULE_FIRMWARE("rtlwifi/rtl8192cufw_TMSC.bin");
57 MODULE_FIRMWARE("rtlwifi/rtl8192eu_nic.bin");
58 MODULE_FIRMWARE("rtlwifi/rtl8723bu_nic.bin");
59 MODULE_FIRMWARE("rtlwifi/rtl8723bu_bt.bin");
60
61 module_param_named(debug, rtl8xxxu_debug, int, 0600);
62 MODULE_PARM_DESC(debug, "Set debug mask");
63 module_param_named(ht40_2g, rtl8xxxu_ht40_2g, bool, 0600);
64 MODULE_PARM_DESC(ht40_2g, "Enable HT40 support on the 2.4GHz band");
65
66 #define USB_VENDOR_ID_REALTEK           0x0bda
67 /* Minimum IEEE80211_MAX_FRAME_LEN */
68 #define RTL_RX_BUFFER_SIZE              IEEE80211_MAX_FRAME_LEN
69 #define RTL8XXXU_RX_URBS                32
70 #define RTL8XXXU_RX_URB_PENDING_WATER   8
71 #define RTL8XXXU_TX_URBS                64
72 #define RTL8XXXU_TX_URB_LOW_WATER       25
73 #define RTL8XXXU_TX_URB_HIGH_WATER      32
74
75 static int rtl8xxxu_submit_rx_urb(struct rtl8xxxu_priv *priv,
76                                   struct rtl8xxxu_rx_urb *rx_urb);
77
78 static struct ieee80211_rate rtl8xxxu_rates[] = {
79         { .bitrate = 10, .hw_value = DESC_RATE_1M, .flags = 0 },
80         { .bitrate = 20, .hw_value = DESC_RATE_2M, .flags = 0 },
81         { .bitrate = 55, .hw_value = DESC_RATE_5_5M, .flags = 0 },
82         { .bitrate = 110, .hw_value = DESC_RATE_11M, .flags = 0 },
83         { .bitrate = 60, .hw_value = DESC_RATE_6M, .flags = 0 },
84         { .bitrate = 90, .hw_value = DESC_RATE_9M, .flags = 0 },
85         { .bitrate = 120, .hw_value = DESC_RATE_12M, .flags = 0 },
86         { .bitrate = 180, .hw_value = DESC_RATE_18M, .flags = 0 },
87         { .bitrate = 240, .hw_value = DESC_RATE_24M, .flags = 0 },
88         { .bitrate = 360, .hw_value = DESC_RATE_36M, .flags = 0 },
89         { .bitrate = 480, .hw_value = DESC_RATE_48M, .flags = 0 },
90         { .bitrate = 540, .hw_value = DESC_RATE_54M, .flags = 0 },
91 };
92
93 static struct ieee80211_channel rtl8xxxu_channels_2g[] = {
94         { .band = NL80211_BAND_2GHZ, .center_freq = 2412,
95           .hw_value = 1, .max_power = 30 },
96         { .band = NL80211_BAND_2GHZ, .center_freq = 2417,
97           .hw_value = 2, .max_power = 30 },
98         { .band = NL80211_BAND_2GHZ, .center_freq = 2422,
99           .hw_value = 3, .max_power = 30 },
100         { .band = NL80211_BAND_2GHZ, .center_freq = 2427,
101           .hw_value = 4, .max_power = 30 },
102         { .band = NL80211_BAND_2GHZ, .center_freq = 2432,
103           .hw_value = 5, .max_power = 30 },
104         { .band = NL80211_BAND_2GHZ, .center_freq = 2437,
105           .hw_value = 6, .max_power = 30 },
106         { .band = NL80211_BAND_2GHZ, .center_freq = 2442,
107           .hw_value = 7, .max_power = 30 },
108         { .band = NL80211_BAND_2GHZ, .center_freq = 2447,
109           .hw_value = 8, .max_power = 30 },
110         { .band = NL80211_BAND_2GHZ, .center_freq = 2452,
111           .hw_value = 9, .max_power = 30 },
112         { .band = NL80211_BAND_2GHZ, .center_freq = 2457,
113           .hw_value = 10, .max_power = 30 },
114         { .band = NL80211_BAND_2GHZ, .center_freq = 2462,
115           .hw_value = 11, .max_power = 30 },
116         { .band = NL80211_BAND_2GHZ, .center_freq = 2467,
117           .hw_value = 12, .max_power = 30 },
118         { .band = NL80211_BAND_2GHZ, .center_freq = 2472,
119           .hw_value = 13, .max_power = 30 },
120         { .band = NL80211_BAND_2GHZ, .center_freq = 2484,
121           .hw_value = 14, .max_power = 30 }
122 };
123
124 static struct ieee80211_supported_band rtl8xxxu_supported_band = {
125         .channels = rtl8xxxu_channels_2g,
126         .n_channels = ARRAY_SIZE(rtl8xxxu_channels_2g),
127         .bitrates = rtl8xxxu_rates,
128         .n_bitrates = ARRAY_SIZE(rtl8xxxu_rates),
129 };
130
131 static struct rtl8xxxu_reg8val rtl8723a_mac_init_table[] = {
132         {0x420, 0x80}, {0x423, 0x00}, {0x430, 0x00}, {0x431, 0x00},
133         {0x432, 0x00}, {0x433, 0x01}, {0x434, 0x04}, {0x435, 0x05},
134         {0x436, 0x06}, {0x437, 0x07}, {0x438, 0x00}, {0x439, 0x00},
135         {0x43a, 0x00}, {0x43b, 0x01}, {0x43c, 0x04}, {0x43d, 0x05},
136         {0x43e, 0x06}, {0x43f, 0x07}, {0x440, 0x5d}, {0x441, 0x01},
137         {0x442, 0x00}, {0x444, 0x15}, {0x445, 0xf0}, {0x446, 0x0f},
138         {0x447, 0x00}, {0x458, 0x41}, {0x459, 0xa8}, {0x45a, 0x72},
139         {0x45b, 0xb9}, {0x460, 0x66}, {0x461, 0x66}, {0x462, 0x08},
140         {0x463, 0x03}, {0x4c8, 0xff}, {0x4c9, 0x08}, {0x4cc, 0xff},
141         {0x4cd, 0xff}, {0x4ce, 0x01}, {0x500, 0x26}, {0x501, 0xa2},
142         {0x502, 0x2f}, {0x503, 0x00}, {0x504, 0x28}, {0x505, 0xa3},
143         {0x506, 0x5e}, {0x507, 0x00}, {0x508, 0x2b}, {0x509, 0xa4},
144         {0x50a, 0x5e}, {0x50b, 0x00}, {0x50c, 0x4f}, {0x50d, 0xa4},
145         {0x50e, 0x00}, {0x50f, 0x00}, {0x512, 0x1c}, {0x514, 0x0a},
146         {0x515, 0x10}, {0x516, 0x0a}, {0x517, 0x10}, {0x51a, 0x16},
147         {0x524, 0x0f}, {0x525, 0x4f}, {0x546, 0x40}, {0x547, 0x00},
148         {0x550, 0x10}, {0x551, 0x10}, {0x559, 0x02}, {0x55a, 0x02},
149         {0x55d, 0xff}, {0x605, 0x30}, {0x608, 0x0e}, {0x609, 0x2a},
150         {0x652, 0x20}, {0x63c, 0x0a}, {0x63d, 0x0a}, {0x63e, 0x0e},
151         {0x63f, 0x0e}, {0x66e, 0x05}, {0x700, 0x21}, {0x701, 0x43},
152         {0x702, 0x65}, {0x703, 0x87}, {0x708, 0x21}, {0x709, 0x43},
153         {0x70a, 0x65}, {0x70b, 0x87}, {0xffff, 0xff},
154 };
155
156 static struct rtl8xxxu_reg8val rtl8723b_mac_init_table[] = {
157         {0x02f, 0x30}, {0x035, 0x00}, {0x039, 0x08}, {0x04e, 0xe0},
158         {0x064, 0x00}, {0x067, 0x20}, {0x428, 0x0a}, {0x429, 0x10},
159         {0x430, 0x00}, {0x431, 0x00},
160         {0x432, 0x00}, {0x433, 0x01}, {0x434, 0x04}, {0x435, 0x05},
161         {0x436, 0x07}, {0x437, 0x08}, {0x43c, 0x04}, {0x43d, 0x05},
162         {0x43e, 0x07}, {0x43f, 0x08}, {0x440, 0x5d}, {0x441, 0x01},
163         {0x442, 0x00}, {0x444, 0x10}, {0x445, 0x00}, {0x446, 0x00},
164         {0x447, 0x00}, {0x448, 0x00}, {0x449, 0xf0}, {0x44a, 0x0f},
165         {0x44b, 0x3e}, {0x44c, 0x10}, {0x44d, 0x00}, {0x44e, 0x00},
166         {0x44f, 0x00}, {0x450, 0x00}, {0x451, 0xf0}, {0x452, 0x0f},
167         {0x453, 0x00}, {0x456, 0x5e}, {0x460, 0x66}, {0x461, 0x66},
168         {0x4c8, 0xff}, {0x4c9, 0x08}, {0x4cc, 0xff},
169         {0x4cd, 0xff}, {0x4ce, 0x01}, {0x500, 0x26}, {0x501, 0xa2},
170         {0x502, 0x2f}, {0x503, 0x00}, {0x504, 0x28}, {0x505, 0xa3},
171         {0x506, 0x5e}, {0x507, 0x00}, {0x508, 0x2b}, {0x509, 0xa4},
172         {0x50a, 0x5e}, {0x50b, 0x00}, {0x50c, 0x4f}, {0x50d, 0xa4},
173         {0x50e, 0x00}, {0x50f, 0x00}, {0x512, 0x1c}, {0x514, 0x0a},
174         {0x516, 0x0a}, {0x525, 0x4f},
175         {0x550, 0x10}, {0x551, 0x10}, {0x559, 0x02}, {0x55c, 0x50},
176         {0x55d, 0xff}, {0x605, 0x30}, {0x608, 0x0e}, {0x609, 0x2a},
177         {0x620, 0xff}, {0x621, 0xff}, {0x622, 0xff}, {0x623, 0xff},
178         {0x624, 0xff}, {0x625, 0xff}, {0x626, 0xff}, {0x627, 0xff},
179         {0x638, 0x50}, {0x63c, 0x0a}, {0x63d, 0x0a}, {0x63e, 0x0e},
180         {0x63f, 0x0e}, {0x640, 0x40}, {0x642, 0x40}, {0x643, 0x00},
181         {0x652, 0xc8}, {0x66e, 0x05}, {0x700, 0x21}, {0x701, 0x43},
182         {0x702, 0x65}, {0x703, 0x87}, {0x708, 0x21}, {0x709, 0x43},
183         {0x70a, 0x65}, {0x70b, 0x87}, {0x765, 0x18}, {0x76e, 0x04},
184         {0xffff, 0xff},
185 };
186
187 static struct rtl8xxxu_reg8val rtl8192e_mac_init_table[] = {
188         {0x011, 0xeb}, {0x012, 0x07}, {0x014, 0x75}, {0x303, 0xa7},
189         {0x428, 0x0a}, {0x429, 0x10}, {0x430, 0x00}, {0x431, 0x00},
190         {0x432, 0x00}, {0x433, 0x01}, {0x434, 0x04}, {0x435, 0x05},
191         {0x436, 0x07}, {0x437, 0x08}, {0x43c, 0x04}, {0x43d, 0x05},
192         {0x43e, 0x07}, {0x43f, 0x08}, {0x440, 0x5d}, {0x441, 0x01},
193         {0x442, 0x00}, {0x444, 0x10}, {0x445, 0x00}, {0x446, 0x00},
194         {0x447, 0x00}, {0x448, 0x00}, {0x449, 0xf0}, {0x44a, 0x0f},
195         {0x44b, 0x3e}, {0x44c, 0x10}, {0x44d, 0x00}, {0x44e, 0x00},
196         {0x44f, 0x00}, {0x450, 0x00}, {0x451, 0xf0}, {0x452, 0x0f},
197         {0x453, 0x00}, {0x456, 0x5e}, {0x460, 0x66}, {0x461, 0x66},
198         {0x4c8, 0xff}, {0x4c9, 0x08}, {0x4cc, 0xff}, {0x4cd, 0xff},
199         {0x4ce, 0x01}, {0x500, 0x26}, {0x501, 0xa2}, {0x502, 0x2f},
200         {0x503, 0x00}, {0x504, 0x28}, {0x505, 0xa3}, {0x506, 0x5e},
201         {0x507, 0x00}, {0x508, 0x2b}, {0x509, 0xa4}, {0x50a, 0x5e},
202         {0x50b, 0x00}, {0x50c, 0x4f}, {0x50d, 0xa4}, {0x50e, 0x00},
203         {0x50f, 0x00}, {0x512, 0x1c}, {0x514, 0x0a}, {0x516, 0x0a},
204         {0x525, 0x4f}, {0x540, 0x12}, {0x541, 0x64}, {0x550, 0x10},
205         {0x551, 0x10}, {0x559, 0x02}, {0x55c, 0x50}, {0x55d, 0xff},
206         {0x605, 0x30}, {0x608, 0x0e}, {0x609, 0x2a}, {0x620, 0xff},
207         {0x621, 0xff}, {0x622, 0xff}, {0x623, 0xff}, {0x624, 0xff},
208         {0x625, 0xff}, {0x626, 0xff}, {0x627, 0xff}, {0x638, 0x50},
209         {0x63c, 0x0a}, {0x63d, 0x0a}, {0x63e, 0x0e}, {0x63f, 0x0e},
210         {0x640, 0x40}, {0x642, 0x40}, {0x643, 0x00}, {0x652, 0xc8},
211         {0x66e, 0x05}, {0x700, 0x21}, {0x701, 0x43}, {0x702, 0x65},
212         {0x703, 0x87}, {0x708, 0x21}, {0x709, 0x43}, {0x70a, 0x65},
213         {0x70b, 0x87},
214         {0xffff, 0xff},
215 };
216
217 static struct rtl8xxxu_reg32val rtl8723a_phy_1t_init_table[] = {
218         {0x800, 0x80040000}, {0x804, 0x00000003},
219         {0x808, 0x0000fc00}, {0x80c, 0x0000000a},
220         {0x810, 0x10001331}, {0x814, 0x020c3d10},
221         {0x818, 0x02200385}, {0x81c, 0x00000000},
222         {0x820, 0x01000100}, {0x824, 0x00390004},
223         {0x828, 0x00000000}, {0x82c, 0x00000000},
224         {0x830, 0x00000000}, {0x834, 0x00000000},
225         {0x838, 0x00000000}, {0x83c, 0x00000000},
226         {0x840, 0x00010000}, {0x844, 0x00000000},
227         {0x848, 0x00000000}, {0x84c, 0x00000000},
228         {0x850, 0x00000000}, {0x854, 0x00000000},
229         {0x858, 0x569a569a}, {0x85c, 0x001b25a4},
230         {0x860, 0x66f60110}, {0x864, 0x061f0130},
231         {0x868, 0x00000000}, {0x86c, 0x32323200},
232         {0x870, 0x07000760}, {0x874, 0x22004000},
233         {0x878, 0x00000808}, {0x87c, 0x00000000},
234         {0x880, 0xc0083070}, {0x884, 0x000004d5},
235         {0x888, 0x00000000}, {0x88c, 0xccc000c0},
236         {0x890, 0x00000800}, {0x894, 0xfffffffe},
237         {0x898, 0x40302010}, {0x89c, 0x00706050},
238         {0x900, 0x00000000}, {0x904, 0x00000023},
239         {0x908, 0x00000000}, {0x90c, 0x81121111},
240         {0xa00, 0x00d047c8}, {0xa04, 0x80ff000c},
241         {0xa08, 0x8c838300}, {0xa0c, 0x2e68120f},
242         {0xa10, 0x9500bb78}, {0xa14, 0x11144028},
243         {0xa18, 0x00881117}, {0xa1c, 0x89140f00},
244         {0xa20, 0x1a1b0000}, {0xa24, 0x090e1317},
245         {0xa28, 0x00000204}, {0xa2c, 0x00d30000},
246         {0xa70, 0x101fbf00}, {0xa74, 0x00000007},
247         {0xa78, 0x00000900},
248         {0xc00, 0x48071d40}, {0xc04, 0x03a05611},
249         {0xc08, 0x000000e4}, {0xc0c, 0x6c6c6c6c},
250         {0xc10, 0x08800000}, {0xc14, 0x40000100},
251         {0xc18, 0x08800000}, {0xc1c, 0x40000100},
252         {0xc20, 0x00000000}, {0xc24, 0x00000000},
253         {0xc28, 0x00000000}, {0xc2c, 0x00000000},
254         {0xc30, 0x69e9ac44}, {0xc34, 0x469652af},
255         {0xc38, 0x49795994}, {0xc3c, 0x0a97971c},
256         {0xc40, 0x1f7c403f}, {0xc44, 0x000100b7},
257         {0xc48, 0xec020107}, {0xc4c, 0x007f037f},
258         {0xc50, 0x69543420}, {0xc54, 0x43bc0094},
259         {0xc58, 0x69543420}, {0xc5c, 0x433c0094},
260         {0xc60, 0x00000000}, {0xc64, 0x7112848b},
261         {0xc68, 0x47c00bff}, {0xc6c, 0x00000036},
262         {0xc70, 0x2c7f000d}, {0xc74, 0x018610db},
263         {0xc78, 0x0000001f}, {0xc7c, 0x00b91612},
264         {0xc80, 0x40000100}, {0xc84, 0x20f60000},
265         {0xc88, 0x40000100}, {0xc8c, 0x20200000},
266         {0xc90, 0x00121820}, {0xc94, 0x00000000},
267         {0xc98, 0x00121820}, {0xc9c, 0x00007f7f},
268         {0xca0, 0x00000000}, {0xca4, 0x00000080},
269         {0xca8, 0x00000000}, {0xcac, 0x00000000},
270         {0xcb0, 0x00000000}, {0xcb4, 0x00000000},
271         {0xcb8, 0x00000000}, {0xcbc, 0x28000000},
272         {0xcc0, 0x00000000}, {0xcc4, 0x00000000},
273         {0xcc8, 0x00000000}, {0xccc, 0x00000000},
274         {0xcd0, 0x00000000}, {0xcd4, 0x00000000},
275         {0xcd8, 0x64b22427}, {0xcdc, 0x00766932},
276         {0xce0, 0x00222222}, {0xce4, 0x00000000},
277         {0xce8, 0x37644302}, {0xcec, 0x2f97d40c},
278         {0xd00, 0x00080740}, {0xd04, 0x00020401},
279         {0xd08, 0x0000907f}, {0xd0c, 0x20010201},
280         {0xd10, 0xa0633333}, {0xd14, 0x3333bc43},
281         {0xd18, 0x7a8f5b6b}, {0xd2c, 0xcc979975},
282         {0xd30, 0x00000000}, {0xd34, 0x80608000},
283         {0xd38, 0x00000000}, {0xd3c, 0x00027293},
284         {0xd40, 0x00000000}, {0xd44, 0x00000000},
285         {0xd48, 0x00000000}, {0xd4c, 0x00000000},
286         {0xd50, 0x6437140a}, {0xd54, 0x00000000},
287         {0xd58, 0x00000000}, {0xd5c, 0x30032064},
288         {0xd60, 0x4653de68}, {0xd64, 0x04518a3c},
289         {0xd68, 0x00002101}, {0xd6c, 0x2a201c16},
290         {0xd70, 0x1812362e}, {0xd74, 0x322c2220},
291         {0xd78, 0x000e3c24}, {0xe00, 0x2a2a2a2a},
292         {0xe04, 0x2a2a2a2a}, {0xe08, 0x03902a2a},
293         {0xe10, 0x2a2a2a2a}, {0xe14, 0x2a2a2a2a},
294         {0xe18, 0x2a2a2a2a}, {0xe1c, 0x2a2a2a2a},
295         {0xe28, 0x00000000}, {0xe30, 0x1000dc1f},
296         {0xe34, 0x10008c1f}, {0xe38, 0x02140102},
297         {0xe3c, 0x681604c2}, {0xe40, 0x01007c00},
298         {0xe44, 0x01004800}, {0xe48, 0xfb000000},
299         {0xe4c, 0x000028d1}, {0xe50, 0x1000dc1f},
300         {0xe54, 0x10008c1f}, {0xe58, 0x02140102},
301         {0xe5c, 0x28160d05}, {0xe60, 0x00000008},
302         {0xe68, 0x001b25a4}, {0xe6c, 0x631b25a0},
303         {0xe70, 0x631b25a0}, {0xe74, 0x081b25a0},
304         {0xe78, 0x081b25a0}, {0xe7c, 0x081b25a0},
305         {0xe80, 0x081b25a0}, {0xe84, 0x631b25a0},
306         {0xe88, 0x081b25a0}, {0xe8c, 0x631b25a0},
307         {0xed0, 0x631b25a0}, {0xed4, 0x631b25a0},
308         {0xed8, 0x631b25a0}, {0xedc, 0x001b25a0},
309         {0xee0, 0x001b25a0}, {0xeec, 0x6b1b25a0},
310         {0xf14, 0x00000003}, {0xf4c, 0x00000000},
311         {0xf00, 0x00000300},
312         {0xffff, 0xffffffff},
313 };
314
315 static struct rtl8xxxu_reg32val rtl8723b_phy_1t_init_table[] = {
316         {0x800, 0x80040000}, {0x804, 0x00000003},
317         {0x808, 0x0000fc00}, {0x80c, 0x0000000a},
318         {0x810, 0x10001331}, {0x814, 0x020c3d10},
319         {0x818, 0x02200385}, {0x81c, 0x00000000},
320         {0x820, 0x01000100}, {0x824, 0x00190204},
321         {0x828, 0x00000000}, {0x82c, 0x00000000},
322         {0x830, 0x00000000}, {0x834, 0x00000000},
323         {0x838, 0x00000000}, {0x83c, 0x00000000},
324         {0x840, 0x00010000}, {0x844, 0x00000000},
325         {0x848, 0x00000000}, {0x84c, 0x00000000},
326         {0x850, 0x00000000}, {0x854, 0x00000000},
327         {0x858, 0x569a11a9}, {0x85c, 0x01000014},
328         {0x860, 0x66f60110}, {0x864, 0x061f0649},
329         {0x868, 0x00000000}, {0x86c, 0x27272700},
330         {0x870, 0x07000760}, {0x874, 0x25004000},
331         {0x878, 0x00000808}, {0x87c, 0x00000000},
332         {0x880, 0xb0000c1c}, {0x884, 0x00000001},
333         {0x888, 0x00000000}, {0x88c, 0xccc000c0},
334         {0x890, 0x00000800}, {0x894, 0xfffffffe},
335         {0x898, 0x40302010}, {0x89c, 0x00706050},
336         {0x900, 0x00000000}, {0x904, 0x00000023},
337         {0x908, 0x00000000}, {0x90c, 0x81121111},
338         {0x910, 0x00000002}, {0x914, 0x00000201},
339         {0xa00, 0x00d047c8}, {0xa04, 0x80ff800c},
340         {0xa08, 0x8c838300}, {0xa0c, 0x2e7f120f},
341         {0xa10, 0x9500bb78}, {0xa14, 0x1114d028},
342         {0xa18, 0x00881117}, {0xa1c, 0x89140f00},
343         {0xa20, 0x1a1b0000}, {0xa24, 0x090e1317},
344         {0xa28, 0x00000204}, {0xa2c, 0x00d30000},
345         {0xa70, 0x101fbf00}, {0xa74, 0x00000007},
346         {0xa78, 0x00000900}, {0xa7c, 0x225b0606},
347         {0xa80, 0x21806490}, {0xb2c, 0x00000000},
348         {0xc00, 0x48071d40}, {0xc04, 0x03a05611},
349         {0xc08, 0x000000e4}, {0xc0c, 0x6c6c6c6c},
350         {0xc10, 0x08800000}, {0xc14, 0x40000100},
351         {0xc18, 0x08800000}, {0xc1c, 0x40000100},
352         {0xc20, 0x00000000}, {0xc24, 0x00000000},
353         {0xc28, 0x00000000}, {0xc2c, 0x00000000},
354         {0xc30, 0x69e9ac44}, {0xc34, 0x469652af},
355         {0xc38, 0x49795994}, {0xc3c, 0x0a97971c},
356         {0xc40, 0x1f7c403f}, {0xc44, 0x000100b7},
357         {0xc48, 0xec020107}, {0xc4c, 0x007f037f},
358         {0xc50, 0x69553420}, {0xc54, 0x43bc0094},
359         {0xc58, 0x00013149}, {0xc5c, 0x00250492},
360         {0xc60, 0x00000000}, {0xc64, 0x7112848b},
361         {0xc68, 0x47c00bff}, {0xc6c, 0x00000036},
362         {0xc70, 0x2c7f000d}, {0xc74, 0x020610db},
363         {0xc78, 0x0000001f}, {0xc7c, 0x00b91612},
364         {0xc80, 0x390000e4}, {0xc84, 0x20f60000},
365         {0xc88, 0x40000100}, {0xc8c, 0x20200000},
366         {0xc90, 0x00020e1a}, {0xc94, 0x00000000},
367         {0xc98, 0x00020e1a}, {0xc9c, 0x00007f7f},
368         {0xca0, 0x00000000}, {0xca4, 0x000300a0},
369         {0xca8, 0x00000000}, {0xcac, 0x00000000},
370         {0xcb0, 0x00000000}, {0xcb4, 0x00000000},
371         {0xcb8, 0x00000000}, {0xcbc, 0x28000000},
372         {0xcc0, 0x00000000}, {0xcc4, 0x00000000},
373         {0xcc8, 0x00000000}, {0xccc, 0x00000000},
374         {0xcd0, 0x00000000}, {0xcd4, 0x00000000},
375         {0xcd8, 0x64b22427}, {0xcdc, 0x00766932},
376         {0xce0, 0x00222222}, {0xce4, 0x00000000},
377         {0xce8, 0x37644302}, {0xcec, 0x2f97d40c},
378         {0xd00, 0x00000740}, {0xd04, 0x40020401},
379         {0xd08, 0x0000907f}, {0xd0c, 0x20010201},
380         {0xd10, 0xa0633333}, {0xd14, 0x3333bc53},
381         {0xd18, 0x7a8f5b6f}, {0xd2c, 0xcc979975},
382         {0xd30, 0x00000000}, {0xd34, 0x80608000},
383         {0xd38, 0x00000000}, {0xd3c, 0x00127353},
384         {0xd40, 0x00000000}, {0xd44, 0x00000000},
385         {0xd48, 0x00000000}, {0xd4c, 0x00000000},
386         {0xd50, 0x6437140a}, {0xd54, 0x00000000},
387         {0xd58, 0x00000282}, {0xd5c, 0x30032064},
388         {0xd60, 0x4653de68}, {0xd64, 0x04518a3c},
389         {0xd68, 0x00002101}, {0xd6c, 0x2a201c16},
390         {0xd70, 0x1812362e}, {0xd74, 0x322c2220},
391         {0xd78, 0x000e3c24}, {0xe00, 0x2d2d2d2d},
392         {0xe04, 0x2d2d2d2d}, {0xe08, 0x0390272d},
393         {0xe10, 0x2d2d2d2d}, {0xe14, 0x2d2d2d2d},
394         {0xe18, 0x2d2d2d2d}, {0xe1c, 0x2d2d2d2d},
395         {0xe28, 0x00000000}, {0xe30, 0x1000dc1f},
396         {0xe34, 0x10008c1f}, {0xe38, 0x02140102},
397         {0xe3c, 0x681604c2}, {0xe40, 0x01007c00},
398         {0xe44, 0x01004800}, {0xe48, 0xfb000000},
399         {0xe4c, 0x000028d1}, {0xe50, 0x1000dc1f},
400         {0xe54, 0x10008c1f}, {0xe58, 0x02140102},
401         {0xe5c, 0x28160d05}, {0xe60, 0x00000008},
402         {0xe68, 0x001b2556}, {0xe6c, 0x00c00096},
403         {0xe70, 0x00c00096}, {0xe74, 0x01000056},
404         {0xe78, 0x01000014}, {0xe7c, 0x01000056},
405         {0xe80, 0x01000014}, {0xe84, 0x00c00096},
406         {0xe88, 0x01000056}, {0xe8c, 0x00c00096},
407         {0xed0, 0x00c00096}, {0xed4, 0x00c00096},
408         {0xed8, 0x00c00096}, {0xedc, 0x000000d6},
409         {0xee0, 0x000000d6}, {0xeec, 0x01c00016},
410         {0xf14, 0x00000003}, {0xf4c, 0x00000000},
411         {0xf00, 0x00000300},
412         {0x820, 0x01000100}, {0x800, 0x83040000},
413         {0xffff, 0xffffffff},
414 };
415
416 static struct rtl8xxxu_reg32val rtl8192cu_phy_2t_init_table[] = {
417         {0x024, 0x0011800f}, {0x028, 0x00ffdb83},
418         {0x800, 0x80040002}, {0x804, 0x00000003},
419         {0x808, 0x0000fc00}, {0x80c, 0x0000000a},
420         {0x810, 0x10000330}, {0x814, 0x020c3d10},
421         {0x818, 0x02200385}, {0x81c, 0x00000000},
422         {0x820, 0x01000100}, {0x824, 0x00390004},
423         {0x828, 0x01000100}, {0x82c, 0x00390004},
424         {0x830, 0x27272727}, {0x834, 0x27272727},
425         {0x838, 0x27272727}, {0x83c, 0x27272727},
426         {0x840, 0x00010000}, {0x844, 0x00010000},
427         {0x848, 0x27272727}, {0x84c, 0x27272727},
428         {0x850, 0x00000000}, {0x854, 0x00000000},
429         {0x858, 0x569a569a}, {0x85c, 0x0c1b25a4},
430         {0x860, 0x66e60230}, {0x864, 0x061f0130},
431         {0x868, 0x27272727}, {0x86c, 0x2b2b2b27},
432         {0x870, 0x07000700}, {0x874, 0x22184000},
433         {0x878, 0x08080808}, {0x87c, 0x00000000},
434         {0x880, 0xc0083070}, {0x884, 0x000004d5},
435         {0x888, 0x00000000}, {0x88c, 0xcc0000c0},
436         {0x890, 0x00000800}, {0x894, 0xfffffffe},
437         {0x898, 0x40302010}, {0x89c, 0x00706050},
438         {0x900, 0x00000000}, {0x904, 0x00000023},
439         {0x908, 0x00000000}, {0x90c, 0x81121313},
440         {0xa00, 0x00d047c8}, {0xa04, 0x80ff000c},
441         {0xa08, 0x8c838300}, {0xa0c, 0x2e68120f},
442         {0xa10, 0x9500bb78}, {0xa14, 0x11144028},
443         {0xa18, 0x00881117}, {0xa1c, 0x89140f00},
444         {0xa20, 0x1a1b0000}, {0xa24, 0x090e1317},
445         {0xa28, 0x00000204}, {0xa2c, 0x00d30000},
446         {0xa70, 0x101fbf00}, {0xa74, 0x00000007},
447         {0xc00, 0x48071d40}, {0xc04, 0x03a05633},
448         {0xc08, 0x000000e4}, {0xc0c, 0x6c6c6c6c},
449         {0xc10, 0x08800000}, {0xc14, 0x40000100},
450         {0xc18, 0x08800000}, {0xc1c, 0x40000100},
451         {0xc20, 0x00000000}, {0xc24, 0x00000000},
452         {0xc28, 0x00000000}, {0xc2c, 0x00000000},
453         {0xc30, 0x69e9ac44}, {0xc34, 0x469652cf},
454         {0xc38, 0x49795994}, {0xc3c, 0x0a97971c},
455         {0xc40, 0x1f7c403f}, {0xc44, 0x000100b7},
456         {0xc48, 0xec020107}, {0xc4c, 0x007f037f},
457         {0xc50, 0x69543420}, {0xc54, 0x43bc0094},
458         {0xc58, 0x69543420}, {0xc5c, 0x433c0094},
459         {0xc60, 0x00000000}, {0xc64, 0x5116848b},
460         {0xc68, 0x47c00bff}, {0xc6c, 0x00000036},
461         {0xc70, 0x2c7f000d}, {0xc74, 0x2186115b},
462         {0xc78, 0x0000001f}, {0xc7c, 0x00b99612},
463         {0xc80, 0x40000100}, {0xc84, 0x20f60000},
464         {0xc88, 0x40000100}, {0xc8c, 0xa0e40000},
465         {0xc90, 0x00121820}, {0xc94, 0x00000000},
466         {0xc98, 0x00121820}, {0xc9c, 0x00007f7f},
467         {0xca0, 0x00000000}, {0xca4, 0x00000080},
468         {0xca8, 0x00000000}, {0xcac, 0x00000000},
469         {0xcb0, 0x00000000}, {0xcb4, 0x00000000},
470         {0xcb8, 0x00000000}, {0xcbc, 0x28000000},
471         {0xcc0, 0x00000000}, {0xcc4, 0x00000000},
472         {0xcc8, 0x00000000}, {0xccc, 0x00000000},
473         {0xcd0, 0x00000000}, {0xcd4, 0x00000000},
474         {0xcd8, 0x64b22427}, {0xcdc, 0x00766932},
475         {0xce0, 0x00222222}, {0xce4, 0x00000000},
476         {0xce8, 0x37644302}, {0xcec, 0x2f97d40c},
477         {0xd00, 0x00080740}, {0xd04, 0x00020403},
478         {0xd08, 0x0000907f}, {0xd0c, 0x20010201},
479         {0xd10, 0xa0633333}, {0xd14, 0x3333bc43},
480         {0xd18, 0x7a8f5b6b}, {0xd2c, 0xcc979975},
481         {0xd30, 0x00000000}, {0xd34, 0x80608000},
482         {0xd38, 0x00000000}, {0xd3c, 0x00027293},
483         {0xd40, 0x00000000}, {0xd44, 0x00000000},
484         {0xd48, 0x00000000}, {0xd4c, 0x00000000},
485         {0xd50, 0x6437140a}, {0xd54, 0x00000000},
486         {0xd58, 0x00000000}, {0xd5c, 0x30032064},
487         {0xd60, 0x4653de68}, {0xd64, 0x04518a3c},
488         {0xd68, 0x00002101}, {0xd6c, 0x2a201c16},
489         {0xd70, 0x1812362e}, {0xd74, 0x322c2220},
490         {0xd78, 0x000e3c24}, {0xe00, 0x2a2a2a2a},
491         {0xe04, 0x2a2a2a2a}, {0xe08, 0x03902a2a},
492         {0xe10, 0x2a2a2a2a}, {0xe14, 0x2a2a2a2a},
493         {0xe18, 0x2a2a2a2a}, {0xe1c, 0x2a2a2a2a},
494         {0xe28, 0x00000000}, {0xe30, 0x1000dc1f},
495         {0xe34, 0x10008c1f}, {0xe38, 0x02140102},
496         {0xe3c, 0x681604c2}, {0xe40, 0x01007c00},
497         {0xe44, 0x01004800}, {0xe48, 0xfb000000},
498         {0xe4c, 0x000028d1}, {0xe50, 0x1000dc1f},
499         {0xe54, 0x10008c1f}, {0xe58, 0x02140102},
500         {0xe5c, 0x28160d05}, {0xe60, 0x00000010},
501         {0xe68, 0x001b25a4}, {0xe6c, 0x63db25a4},
502         {0xe70, 0x63db25a4}, {0xe74, 0x0c1b25a4},
503         {0xe78, 0x0c1b25a4}, {0xe7c, 0x0c1b25a4},
504         {0xe80, 0x0c1b25a4}, {0xe84, 0x63db25a4},
505         {0xe88, 0x0c1b25a4}, {0xe8c, 0x63db25a4},
506         {0xed0, 0x63db25a4}, {0xed4, 0x63db25a4},
507         {0xed8, 0x63db25a4}, {0xedc, 0x001b25a4},
508         {0xee0, 0x001b25a4}, {0xeec, 0x6fdb25a4},
509         {0xf14, 0x00000003}, {0xf4c, 0x00000000},
510         {0xf00, 0x00000300},
511         {0xffff, 0xffffffff},
512 };
513
514 static struct rtl8xxxu_reg32val rtl8188ru_phy_1t_highpa_table[] = {
515         {0x024, 0x0011800f}, {0x028, 0x00ffdb83},
516         {0x040, 0x000c0004}, {0x800, 0x80040000},
517         {0x804, 0x00000001}, {0x808, 0x0000fc00},
518         {0x80c, 0x0000000a}, {0x810, 0x10005388},
519         {0x814, 0x020c3d10}, {0x818, 0x02200385},
520         {0x81c, 0x00000000}, {0x820, 0x01000100},
521         {0x824, 0x00390204}, {0x828, 0x00000000},
522         {0x82c, 0x00000000}, {0x830, 0x00000000},
523         {0x834, 0x00000000}, {0x838, 0x00000000},
524         {0x83c, 0x00000000}, {0x840, 0x00010000},
525         {0x844, 0x00000000}, {0x848, 0x00000000},
526         {0x84c, 0x00000000}, {0x850, 0x00000000},
527         {0x854, 0x00000000}, {0x858, 0x569a569a},
528         {0x85c, 0x001b25a4}, {0x860, 0x66e60230},
529         {0x864, 0x061f0130}, {0x868, 0x00000000},
530         {0x86c, 0x20202000}, {0x870, 0x03000300},
531         {0x874, 0x22004000}, {0x878, 0x00000808},
532         {0x87c, 0x00ffc3f1}, {0x880, 0xc0083070},
533         {0x884, 0x000004d5}, {0x888, 0x00000000},
534         {0x88c, 0xccc000c0}, {0x890, 0x00000800},
535         {0x894, 0xfffffffe}, {0x898, 0x40302010},
536         {0x89c, 0x00706050}, {0x900, 0x00000000},
537         {0x904, 0x00000023}, {0x908, 0x00000000},
538         {0x90c, 0x81121111}, {0xa00, 0x00d047c8},
539         {0xa04, 0x80ff000c}, {0xa08, 0x8c838300},
540         {0xa0c, 0x2e68120f}, {0xa10, 0x9500bb78},
541         {0xa14, 0x11144028}, {0xa18, 0x00881117},
542         {0xa1c, 0x89140f00}, {0xa20, 0x15160000},
543         {0xa24, 0x070b0f12}, {0xa28, 0x00000104},
544         {0xa2c, 0x00d30000}, {0xa70, 0x101fbf00},
545         {0xa74, 0x00000007}, {0xc00, 0x48071d40},
546         {0xc04, 0x03a05611}, {0xc08, 0x000000e4},
547         {0xc0c, 0x6c6c6c6c}, {0xc10, 0x08800000},
548         {0xc14, 0x40000100}, {0xc18, 0x08800000},
549         {0xc1c, 0x40000100}, {0xc20, 0x00000000},
550         {0xc24, 0x00000000}, {0xc28, 0x00000000},
551         {0xc2c, 0x00000000}, {0xc30, 0x69e9ac44},
552         {0xc34, 0x469652cf}, {0xc38, 0x49795994},
553         {0xc3c, 0x0a97971c}, {0xc40, 0x1f7c403f},
554         {0xc44, 0x000100b7}, {0xc48, 0xec020107},
555         {0xc4c, 0x007f037f}, {0xc50, 0x6954342e},
556         {0xc54, 0x43bc0094}, {0xc58, 0x6954342f},
557         {0xc5c, 0x433c0094}, {0xc60, 0x00000000},
558         {0xc64, 0x5116848b}, {0xc68, 0x47c00bff},
559         {0xc6c, 0x00000036}, {0xc70, 0x2c46000d},
560         {0xc74, 0x018610db}, {0xc78, 0x0000001f},
561         {0xc7c, 0x00b91612}, {0xc80, 0x24000090},
562         {0xc84, 0x20f60000}, {0xc88, 0x24000090},
563         {0xc8c, 0x20200000}, {0xc90, 0x00121820},
564         {0xc94, 0x00000000}, {0xc98, 0x00121820},
565         {0xc9c, 0x00007f7f}, {0xca0, 0x00000000},
566         {0xca4, 0x00000080}, {0xca8, 0x00000000},
567         {0xcac, 0x00000000}, {0xcb0, 0x00000000},
568         {0xcb4, 0x00000000}, {0xcb8, 0x00000000},
569         {0xcbc, 0x28000000}, {0xcc0, 0x00000000},
570         {0xcc4, 0x00000000}, {0xcc8, 0x00000000},
571         {0xccc, 0x00000000}, {0xcd0, 0x00000000},
572         {0xcd4, 0x00000000}, {0xcd8, 0x64b22427},
573         {0xcdc, 0x00766932}, {0xce0, 0x00222222},
574         {0xce4, 0x00000000}, {0xce8, 0x37644302},
575         {0xcec, 0x2f97d40c}, {0xd00, 0x00080740},
576         {0xd04, 0x00020401}, {0xd08, 0x0000907f},
577         {0xd0c, 0x20010201}, {0xd10, 0xa0633333},
578         {0xd14, 0x3333bc43}, {0xd18, 0x7a8f5b6b},
579         {0xd2c, 0xcc979975}, {0xd30, 0x00000000},
580         {0xd34, 0x80608000}, {0xd38, 0x00000000},
581         {0xd3c, 0x00027293}, {0xd40, 0x00000000},
582         {0xd44, 0x00000000}, {0xd48, 0x00000000},
583         {0xd4c, 0x00000000}, {0xd50, 0x6437140a},
584         {0xd54, 0x00000000}, {0xd58, 0x00000000},
585         {0xd5c, 0x30032064}, {0xd60, 0x4653de68},
586         {0xd64, 0x04518a3c}, {0xd68, 0x00002101},
587         {0xd6c, 0x2a201c16}, {0xd70, 0x1812362e},
588         {0xd74, 0x322c2220}, {0xd78, 0x000e3c24},
589         {0xe00, 0x24242424}, {0xe04, 0x24242424},
590         {0xe08, 0x03902024}, {0xe10, 0x24242424},
591         {0xe14, 0x24242424}, {0xe18, 0x24242424},
592         {0xe1c, 0x24242424}, {0xe28, 0x00000000},
593         {0xe30, 0x1000dc1f}, {0xe34, 0x10008c1f},
594         {0xe38, 0x02140102}, {0xe3c, 0x681604c2},
595         {0xe40, 0x01007c00}, {0xe44, 0x01004800},
596         {0xe48, 0xfb000000}, {0xe4c, 0x000028d1},
597         {0xe50, 0x1000dc1f}, {0xe54, 0x10008c1f},
598         {0xe58, 0x02140102}, {0xe5c, 0x28160d05},
599         {0xe60, 0x00000008}, {0xe68, 0x001b25a4},
600         {0xe6c, 0x631b25a0}, {0xe70, 0x631b25a0},
601         {0xe74, 0x081b25a0}, {0xe78, 0x081b25a0},
602         {0xe7c, 0x081b25a0}, {0xe80, 0x081b25a0},
603         {0xe84, 0x631b25a0}, {0xe88, 0x081b25a0},
604         {0xe8c, 0x631b25a0}, {0xed0, 0x631b25a0},
605         {0xed4, 0x631b25a0}, {0xed8, 0x631b25a0},
606         {0xedc, 0x001b25a0}, {0xee0, 0x001b25a0},
607         {0xeec, 0x6b1b25a0}, {0xee8, 0x31555448},
608         {0xf14, 0x00000003}, {0xf4c, 0x00000000},
609         {0xf00, 0x00000300},
610         {0xffff, 0xffffffff},
611 };
612
613 static struct rtl8xxxu_reg32val rtl8192eu_phy_init_table[] = {
614         {0x800, 0x80040000}, {0x804, 0x00000003},
615         {0x808, 0x0000fc00}, {0x80c, 0x0000000a},
616         {0x810, 0x10001331}, {0x814, 0x020c3d10},
617         {0x818, 0x02220385}, {0x81c, 0x00000000},
618         {0x820, 0x01000100}, {0x824, 0x00390204},
619         {0x828, 0x01000100}, {0x82c, 0x00390204},
620         {0x830, 0x32323232}, {0x834, 0x30303030},
621         {0x838, 0x30303030}, {0x83c, 0x30303030},
622         {0x840, 0x00010000}, {0x844, 0x00010000},
623         {0x848, 0x28282828}, {0x84c, 0x28282828},
624         {0x850, 0x00000000}, {0x854, 0x00000000},
625         {0x858, 0x009a009a}, {0x85c, 0x01000014},
626         {0x860, 0x66f60000}, {0x864, 0x061f0000},
627         {0x868, 0x30303030}, {0x86c, 0x30303030},
628         {0x870, 0x00000000}, {0x874, 0x55004200},
629         {0x878, 0x08080808}, {0x87c, 0x00000000},
630         {0x880, 0xb0000c1c}, {0x884, 0x00000001},
631         {0x888, 0x00000000}, {0x88c, 0xcc0000c0},
632         {0x890, 0x00000800}, {0x894, 0xfffffffe},
633         {0x898, 0x40302010}, {0x900, 0x00000000},
634         {0x904, 0x00000023}, {0x908, 0x00000000},
635         {0x90c, 0x81121313}, {0x910, 0x806c0001},
636         {0x914, 0x00000001}, {0x918, 0x00000000},
637         {0x91c, 0x00010000}, {0x924, 0x00000001},
638         {0x928, 0x00000000}, {0x92c, 0x00000000},
639         {0x930, 0x00000000}, {0x934, 0x00000000},
640         {0x938, 0x00000000}, {0x93c, 0x00000000},
641         {0x940, 0x00000000}, {0x944, 0x00000000},
642         {0x94c, 0x00000008}, {0xa00, 0x00d0c7c8},
643         {0xa04, 0x81ff000c}, {0xa08, 0x8c838300},
644         {0xa0c, 0x2e68120f}, {0xa10, 0x95009b78},
645         {0xa14, 0x1114d028}, {0xa18, 0x00881117},
646         {0xa1c, 0x89140f00}, {0xa20, 0x1a1b0000},
647         {0xa24, 0x090e1317}, {0xa28, 0x00000204},
648         {0xa2c, 0x00d30000}, {0xa70, 0x101fff00},
649         {0xa74, 0x00000007}, {0xa78, 0x00000900},
650         {0xa7c, 0x225b0606}, {0xa80, 0x218075b1},
651         {0xb38, 0x00000000}, {0xc00, 0x48071d40},
652         {0xc04, 0x03a05633}, {0xc08, 0x000000e4},
653         {0xc0c, 0x6c6c6c6c}, {0xc10, 0x08800000},
654         {0xc14, 0x40000100}, {0xc18, 0x08800000},
655         {0xc1c, 0x40000100}, {0xc20, 0x00000000},
656         {0xc24, 0x00000000}, {0xc28, 0x00000000},
657         {0xc2c, 0x00000000}, {0xc30, 0x69e9ac47},
658         {0xc34, 0x469652af}, {0xc38, 0x49795994},
659         {0xc3c, 0x0a97971c}, {0xc40, 0x1f7c403f},
660         {0xc44, 0x000100b7}, {0xc48, 0xec020107},
661         {0xc4c, 0x007f037f},
662 #ifdef EXT_PA_8192EU
663         /* External PA or external LNA */
664         {0xc50, 0x00340220},
665 #else
666         {0xc50, 0x00340020},
667 #endif
668         {0xc54, 0x0080801f},
669 #ifdef EXT_PA_8192EU
670         /* External PA or external LNA */
671         {0xc58, 0x00000220},
672 #else
673         {0xc58, 0x00000020},
674 #endif
675         {0xc5c, 0x00248492}, {0xc60, 0x00000000},
676         {0xc64, 0x7112848b}, {0xc68, 0x47c00bff},
677         {0xc6c, 0x00000036}, {0xc70, 0x00000600},
678         {0xc74, 0x02013169}, {0xc78, 0x0000001f},
679         {0xc7c, 0x00b91612},
680 #ifdef EXT_PA_8192EU
681         /* External PA or external LNA */
682         {0xc80, 0x2d4000b5},
683 #else
684         {0xc80, 0x40000100},
685 #endif
686         {0xc84, 0x21f60000},
687 #ifdef EXT_PA_8192EU
688         /* External PA or external LNA */
689         {0xc88, 0x2d4000b5},
690 #else
691         {0xc88, 0x40000100},
692 #endif
693         {0xc8c, 0xa0e40000}, {0xc90, 0x00121820},
694         {0xc94, 0x00000000}, {0xc98, 0x00121820},
695         {0xc9c, 0x00007f7f}, {0xca0, 0x00000000},
696         {0xca4, 0x000300a0}, {0xca8, 0x00000000},
697         {0xcac, 0x00000000}, {0xcb0, 0x00000000},
698         {0xcb4, 0x00000000}, {0xcb8, 0x00000000},
699         {0xcbc, 0x28000000}, {0xcc0, 0x00000000},
700         {0xcc4, 0x00000000}, {0xcc8, 0x00000000},
701         {0xccc, 0x00000000}, {0xcd0, 0x00000000},
702         {0xcd4, 0x00000000}, {0xcd8, 0x64b22427},
703         {0xcdc, 0x00766932}, {0xce0, 0x00222222},
704         {0xce4, 0x00040000}, {0xce8, 0x77644302},
705         {0xcec, 0x2f97d40c}, {0xd00, 0x00080740},
706         {0xd04, 0x00020403}, {0xd08, 0x0000907f},
707         {0xd0c, 0x20010201}, {0xd10, 0xa0633333},
708         {0xd14, 0x3333bc43}, {0xd18, 0x7a8f5b6b},
709         {0xd1c, 0x0000007f}, {0xd2c, 0xcc979975},
710         {0xd30, 0x00000000}, {0xd34, 0x80608000},
711         {0xd38, 0x00000000}, {0xd3c, 0x00127353},
712         {0xd40, 0x00000000}, {0xd44, 0x00000000},
713         {0xd48, 0x00000000}, {0xd4c, 0x00000000},
714         {0xd50, 0x6437140a}, {0xd54, 0x00000000},
715         {0xd58, 0x00000282}, {0xd5c, 0x30032064},
716         {0xd60, 0x4653de68}, {0xd64, 0x04518a3c},
717         {0xd68, 0x00002101}, {0xd6c, 0x2a201c16},
718         {0xd70, 0x1812362e}, {0xd74, 0x322c2220},
719         {0xd78, 0x000e3c24}, {0xd80, 0x01081008},
720         {0xd84, 0x00000800}, {0xd88, 0xf0b50000},
721         {0xe00, 0x30303030}, {0xe04, 0x30303030},
722         {0xe08, 0x03903030}, {0xe10, 0x30303030},
723         {0xe14, 0x30303030}, {0xe18, 0x30303030},
724         {0xe1c, 0x30303030}, {0xe28, 0x00000000},
725         {0xe30, 0x1000dc1f}, {0xe34, 0x10008c1f},
726         {0xe38, 0x02140102}, {0xe3c, 0x681604c2},
727         {0xe40, 0x01007c00}, {0xe44, 0x01004800},
728         {0xe48, 0xfb000000}, {0xe4c, 0x000028d1},
729         {0xe50, 0x1000dc1f}, {0xe54, 0x10008c1f},
730         {0xe58, 0x02140102}, {0xe5c, 0x28160d05},
731         {0xe60, 0x00000008}, {0xe68, 0x0fc05656},
732         {0xe6c, 0x03c09696}, {0xe70, 0x03c09696},
733         {0xe74, 0x0c005656}, {0xe78, 0x0c005656},
734         {0xe7c, 0x0c005656}, {0xe80, 0x0c005656},
735         {0xe84, 0x03c09696}, {0xe88, 0x0c005656},
736         {0xe8c, 0x03c09696}, {0xed0, 0x03c09696},
737         {0xed4, 0x03c09696}, {0xed8, 0x03c09696},
738         {0xedc, 0x0000d6d6}, {0xee0, 0x0000d6d6},
739         {0xeec, 0x0fc01616}, {0xee4, 0xb0000c1c},
740         {0xee8, 0x00000001}, {0xf14, 0x00000003},
741         {0xf4c, 0x00000000}, {0xf00, 0x00000300},
742         {0xffff, 0xffffffff},
743 };
744
745 static struct rtl8xxxu_reg32val rtl8xxx_agc_standard_table[] = {
746         {0xc78, 0x7b000001}, {0xc78, 0x7b010001},
747         {0xc78, 0x7b020001}, {0xc78, 0x7b030001},
748         {0xc78, 0x7b040001}, {0xc78, 0x7b050001},
749         {0xc78, 0x7a060001}, {0xc78, 0x79070001},
750         {0xc78, 0x78080001}, {0xc78, 0x77090001},
751         {0xc78, 0x760a0001}, {0xc78, 0x750b0001},
752         {0xc78, 0x740c0001}, {0xc78, 0x730d0001},
753         {0xc78, 0x720e0001}, {0xc78, 0x710f0001},
754         {0xc78, 0x70100001}, {0xc78, 0x6f110001},
755         {0xc78, 0x6e120001}, {0xc78, 0x6d130001},
756         {0xc78, 0x6c140001}, {0xc78, 0x6b150001},
757         {0xc78, 0x6a160001}, {0xc78, 0x69170001},
758         {0xc78, 0x68180001}, {0xc78, 0x67190001},
759         {0xc78, 0x661a0001}, {0xc78, 0x651b0001},
760         {0xc78, 0x641c0001}, {0xc78, 0x631d0001},
761         {0xc78, 0x621e0001}, {0xc78, 0x611f0001},
762         {0xc78, 0x60200001}, {0xc78, 0x49210001},
763         {0xc78, 0x48220001}, {0xc78, 0x47230001},
764         {0xc78, 0x46240001}, {0xc78, 0x45250001},
765         {0xc78, 0x44260001}, {0xc78, 0x43270001},
766         {0xc78, 0x42280001}, {0xc78, 0x41290001},
767         {0xc78, 0x402a0001}, {0xc78, 0x262b0001},
768         {0xc78, 0x252c0001}, {0xc78, 0x242d0001},
769         {0xc78, 0x232e0001}, {0xc78, 0x222f0001},
770         {0xc78, 0x21300001}, {0xc78, 0x20310001},
771         {0xc78, 0x06320001}, {0xc78, 0x05330001},
772         {0xc78, 0x04340001}, {0xc78, 0x03350001},
773         {0xc78, 0x02360001}, {0xc78, 0x01370001},
774         {0xc78, 0x00380001}, {0xc78, 0x00390001},
775         {0xc78, 0x003a0001}, {0xc78, 0x003b0001},
776         {0xc78, 0x003c0001}, {0xc78, 0x003d0001},
777         {0xc78, 0x003e0001}, {0xc78, 0x003f0001},
778         {0xc78, 0x7b400001}, {0xc78, 0x7b410001},
779         {0xc78, 0x7b420001}, {0xc78, 0x7b430001},
780         {0xc78, 0x7b440001}, {0xc78, 0x7b450001},
781         {0xc78, 0x7a460001}, {0xc78, 0x79470001},
782         {0xc78, 0x78480001}, {0xc78, 0x77490001},
783         {0xc78, 0x764a0001}, {0xc78, 0x754b0001},
784         {0xc78, 0x744c0001}, {0xc78, 0x734d0001},
785         {0xc78, 0x724e0001}, {0xc78, 0x714f0001},
786         {0xc78, 0x70500001}, {0xc78, 0x6f510001},
787         {0xc78, 0x6e520001}, {0xc78, 0x6d530001},
788         {0xc78, 0x6c540001}, {0xc78, 0x6b550001},
789         {0xc78, 0x6a560001}, {0xc78, 0x69570001},
790         {0xc78, 0x68580001}, {0xc78, 0x67590001},
791         {0xc78, 0x665a0001}, {0xc78, 0x655b0001},
792         {0xc78, 0x645c0001}, {0xc78, 0x635d0001},
793         {0xc78, 0x625e0001}, {0xc78, 0x615f0001},
794         {0xc78, 0x60600001}, {0xc78, 0x49610001},
795         {0xc78, 0x48620001}, {0xc78, 0x47630001},
796         {0xc78, 0x46640001}, {0xc78, 0x45650001},
797         {0xc78, 0x44660001}, {0xc78, 0x43670001},
798         {0xc78, 0x42680001}, {0xc78, 0x41690001},
799         {0xc78, 0x406a0001}, {0xc78, 0x266b0001},
800         {0xc78, 0x256c0001}, {0xc78, 0x246d0001},
801         {0xc78, 0x236e0001}, {0xc78, 0x226f0001},
802         {0xc78, 0x21700001}, {0xc78, 0x20710001},
803         {0xc78, 0x06720001}, {0xc78, 0x05730001},
804         {0xc78, 0x04740001}, {0xc78, 0x03750001},
805         {0xc78, 0x02760001}, {0xc78, 0x01770001},
806         {0xc78, 0x00780001}, {0xc78, 0x00790001},
807         {0xc78, 0x007a0001}, {0xc78, 0x007b0001},
808         {0xc78, 0x007c0001}, {0xc78, 0x007d0001},
809         {0xc78, 0x007e0001}, {0xc78, 0x007f0001},
810         {0xc78, 0x3800001e}, {0xc78, 0x3801001e},
811         {0xc78, 0x3802001e}, {0xc78, 0x3803001e},
812         {0xc78, 0x3804001e}, {0xc78, 0x3805001e},
813         {0xc78, 0x3806001e}, {0xc78, 0x3807001e},
814         {0xc78, 0x3808001e}, {0xc78, 0x3c09001e},
815         {0xc78, 0x3e0a001e}, {0xc78, 0x400b001e},
816         {0xc78, 0x440c001e}, {0xc78, 0x480d001e},
817         {0xc78, 0x4c0e001e}, {0xc78, 0x500f001e},
818         {0xc78, 0x5210001e}, {0xc78, 0x5611001e},
819         {0xc78, 0x5a12001e}, {0xc78, 0x5e13001e},
820         {0xc78, 0x6014001e}, {0xc78, 0x6015001e},
821         {0xc78, 0x6016001e}, {0xc78, 0x6217001e},
822         {0xc78, 0x6218001e}, {0xc78, 0x6219001e},
823         {0xc78, 0x621a001e}, {0xc78, 0x621b001e},
824         {0xc78, 0x621c001e}, {0xc78, 0x621d001e},
825         {0xc78, 0x621e001e}, {0xc78, 0x621f001e},
826         {0xffff, 0xffffffff}
827 };
828
829 static struct rtl8xxxu_reg32val rtl8xxx_agc_highpa_table[] = {
830         {0xc78, 0x7b000001}, {0xc78, 0x7b010001},
831         {0xc78, 0x7b020001}, {0xc78, 0x7b030001},
832         {0xc78, 0x7b040001}, {0xc78, 0x7b050001},
833         {0xc78, 0x7b060001}, {0xc78, 0x7b070001},
834         {0xc78, 0x7b080001}, {0xc78, 0x7a090001},
835         {0xc78, 0x790a0001}, {0xc78, 0x780b0001},
836         {0xc78, 0x770c0001}, {0xc78, 0x760d0001},
837         {0xc78, 0x750e0001}, {0xc78, 0x740f0001},
838         {0xc78, 0x73100001}, {0xc78, 0x72110001},
839         {0xc78, 0x71120001}, {0xc78, 0x70130001},
840         {0xc78, 0x6f140001}, {0xc78, 0x6e150001},
841         {0xc78, 0x6d160001}, {0xc78, 0x6c170001},
842         {0xc78, 0x6b180001}, {0xc78, 0x6a190001},
843         {0xc78, 0x691a0001}, {0xc78, 0x681b0001},
844         {0xc78, 0x671c0001}, {0xc78, 0x661d0001},
845         {0xc78, 0x651e0001}, {0xc78, 0x641f0001},
846         {0xc78, 0x63200001}, {0xc78, 0x62210001},
847         {0xc78, 0x61220001}, {0xc78, 0x60230001},
848         {0xc78, 0x46240001}, {0xc78, 0x45250001},
849         {0xc78, 0x44260001}, {0xc78, 0x43270001},
850         {0xc78, 0x42280001}, {0xc78, 0x41290001},
851         {0xc78, 0x402a0001}, {0xc78, 0x262b0001},
852         {0xc78, 0x252c0001}, {0xc78, 0x242d0001},
853         {0xc78, 0x232e0001}, {0xc78, 0x222f0001},
854         {0xc78, 0x21300001}, {0xc78, 0x20310001},
855         {0xc78, 0x06320001}, {0xc78, 0x05330001},
856         {0xc78, 0x04340001}, {0xc78, 0x03350001},
857         {0xc78, 0x02360001}, {0xc78, 0x01370001},
858         {0xc78, 0x00380001}, {0xc78, 0x00390001},
859         {0xc78, 0x003a0001}, {0xc78, 0x003b0001},
860         {0xc78, 0x003c0001}, {0xc78, 0x003d0001},
861         {0xc78, 0x003e0001}, {0xc78, 0x003f0001},
862         {0xc78, 0x7b400001}, {0xc78, 0x7b410001},
863         {0xc78, 0x7b420001}, {0xc78, 0x7b430001},
864         {0xc78, 0x7b440001}, {0xc78, 0x7b450001},
865         {0xc78, 0x7b460001}, {0xc78, 0x7b470001},
866         {0xc78, 0x7b480001}, {0xc78, 0x7a490001},
867         {0xc78, 0x794a0001}, {0xc78, 0x784b0001},
868         {0xc78, 0x774c0001}, {0xc78, 0x764d0001},
869         {0xc78, 0x754e0001}, {0xc78, 0x744f0001},
870         {0xc78, 0x73500001}, {0xc78, 0x72510001},
871         {0xc78, 0x71520001}, {0xc78, 0x70530001},
872         {0xc78, 0x6f540001}, {0xc78, 0x6e550001},
873         {0xc78, 0x6d560001}, {0xc78, 0x6c570001},
874         {0xc78, 0x6b580001}, {0xc78, 0x6a590001},
875         {0xc78, 0x695a0001}, {0xc78, 0x685b0001},
876         {0xc78, 0x675c0001}, {0xc78, 0x665d0001},
877         {0xc78, 0x655e0001}, {0xc78, 0x645f0001},
878         {0xc78, 0x63600001}, {0xc78, 0x62610001},
879         {0xc78, 0x61620001}, {0xc78, 0x60630001},
880         {0xc78, 0x46640001}, {0xc78, 0x45650001},
881         {0xc78, 0x44660001}, {0xc78, 0x43670001},
882         {0xc78, 0x42680001}, {0xc78, 0x41690001},
883         {0xc78, 0x406a0001}, {0xc78, 0x266b0001},
884         {0xc78, 0x256c0001}, {0xc78, 0x246d0001},
885         {0xc78, 0x236e0001}, {0xc78, 0x226f0001},
886         {0xc78, 0x21700001}, {0xc78, 0x20710001},
887         {0xc78, 0x06720001}, {0xc78, 0x05730001},
888         {0xc78, 0x04740001}, {0xc78, 0x03750001},
889         {0xc78, 0x02760001}, {0xc78, 0x01770001},
890         {0xc78, 0x00780001}, {0xc78, 0x00790001},
891         {0xc78, 0x007a0001}, {0xc78, 0x007b0001},
892         {0xc78, 0x007c0001}, {0xc78, 0x007d0001},
893         {0xc78, 0x007e0001}, {0xc78, 0x007f0001},
894         {0xc78, 0x3800001e}, {0xc78, 0x3801001e},
895         {0xc78, 0x3802001e}, {0xc78, 0x3803001e},
896         {0xc78, 0x3804001e}, {0xc78, 0x3805001e},
897         {0xc78, 0x3806001e}, {0xc78, 0x3807001e},
898         {0xc78, 0x3808001e}, {0xc78, 0x3c09001e},
899         {0xc78, 0x3e0a001e}, {0xc78, 0x400b001e},
900         {0xc78, 0x440c001e}, {0xc78, 0x480d001e},
901         {0xc78, 0x4c0e001e}, {0xc78, 0x500f001e},
902         {0xc78, 0x5210001e}, {0xc78, 0x5611001e},
903         {0xc78, 0x5a12001e}, {0xc78, 0x5e13001e},
904         {0xc78, 0x6014001e}, {0xc78, 0x6015001e},
905         {0xc78, 0x6016001e}, {0xc78, 0x6217001e},
906         {0xc78, 0x6218001e}, {0xc78, 0x6219001e},
907         {0xc78, 0x621a001e}, {0xc78, 0x621b001e},
908         {0xc78, 0x621c001e}, {0xc78, 0x621d001e},
909         {0xc78, 0x621e001e}, {0xc78, 0x621f001e},
910         {0xffff, 0xffffffff}
911 };
912
913 static struct rtl8xxxu_reg32val rtl8xxx_agc_8723bu_table[] = {
914         {0xc78, 0xfd000001}, {0xc78, 0xfc010001},
915         {0xc78, 0xfb020001}, {0xc78, 0xfa030001},
916         {0xc78, 0xf9040001}, {0xc78, 0xf8050001},
917         {0xc78, 0xf7060001}, {0xc78, 0xf6070001},
918         {0xc78, 0xf5080001}, {0xc78, 0xf4090001},
919         {0xc78, 0xf30a0001}, {0xc78, 0xf20b0001},
920         {0xc78, 0xf10c0001}, {0xc78, 0xf00d0001},
921         {0xc78, 0xef0e0001}, {0xc78, 0xee0f0001},
922         {0xc78, 0xed100001}, {0xc78, 0xec110001},
923         {0xc78, 0xeb120001}, {0xc78, 0xea130001},
924         {0xc78, 0xe9140001}, {0xc78, 0xe8150001},
925         {0xc78, 0xe7160001}, {0xc78, 0xe6170001},
926         {0xc78, 0xe5180001}, {0xc78, 0xe4190001},
927         {0xc78, 0xe31a0001}, {0xc78, 0xa51b0001},
928         {0xc78, 0xa41c0001}, {0xc78, 0xa31d0001},
929         {0xc78, 0x671e0001}, {0xc78, 0x661f0001},
930         {0xc78, 0x65200001}, {0xc78, 0x64210001},
931         {0xc78, 0x63220001}, {0xc78, 0x4a230001},
932         {0xc78, 0x49240001}, {0xc78, 0x48250001},
933         {0xc78, 0x47260001}, {0xc78, 0x46270001},
934         {0xc78, 0x45280001}, {0xc78, 0x44290001},
935         {0xc78, 0x432a0001}, {0xc78, 0x422b0001},
936         {0xc78, 0x292c0001}, {0xc78, 0x282d0001},
937         {0xc78, 0x272e0001}, {0xc78, 0x262f0001},
938         {0xc78, 0x0a300001}, {0xc78, 0x09310001},
939         {0xc78, 0x08320001}, {0xc78, 0x07330001},
940         {0xc78, 0x06340001}, {0xc78, 0x05350001},
941         {0xc78, 0x04360001}, {0xc78, 0x03370001},
942         {0xc78, 0x02380001}, {0xc78, 0x01390001},
943         {0xc78, 0x013a0001}, {0xc78, 0x013b0001},
944         {0xc78, 0x013c0001}, {0xc78, 0x013d0001},
945         {0xc78, 0x013e0001}, {0xc78, 0x013f0001},
946         {0xc78, 0xfc400001}, {0xc78, 0xfb410001},
947         {0xc78, 0xfa420001}, {0xc78, 0xf9430001},
948         {0xc78, 0xf8440001}, {0xc78, 0xf7450001},
949         {0xc78, 0xf6460001}, {0xc78, 0xf5470001},
950         {0xc78, 0xf4480001}, {0xc78, 0xf3490001},
951         {0xc78, 0xf24a0001}, {0xc78, 0xf14b0001},
952         {0xc78, 0xf04c0001}, {0xc78, 0xef4d0001},
953         {0xc78, 0xee4e0001}, {0xc78, 0xed4f0001},
954         {0xc78, 0xec500001}, {0xc78, 0xeb510001},
955         {0xc78, 0xea520001}, {0xc78, 0xe9530001},
956         {0xc78, 0xe8540001}, {0xc78, 0xe7550001},
957         {0xc78, 0xe6560001}, {0xc78, 0xe5570001},
958         {0xc78, 0xe4580001}, {0xc78, 0xe3590001},
959         {0xc78, 0xa65a0001}, {0xc78, 0xa55b0001},
960         {0xc78, 0xa45c0001}, {0xc78, 0xa35d0001},
961         {0xc78, 0x675e0001}, {0xc78, 0x665f0001},
962         {0xc78, 0x65600001}, {0xc78, 0x64610001},
963         {0xc78, 0x63620001}, {0xc78, 0x62630001},
964         {0xc78, 0x61640001}, {0xc78, 0x48650001},
965         {0xc78, 0x47660001}, {0xc78, 0x46670001},
966         {0xc78, 0x45680001}, {0xc78, 0x44690001},
967         {0xc78, 0x436a0001}, {0xc78, 0x426b0001},
968         {0xc78, 0x286c0001}, {0xc78, 0x276d0001},
969         {0xc78, 0x266e0001}, {0xc78, 0x256f0001},
970         {0xc78, 0x24700001}, {0xc78, 0x09710001},
971         {0xc78, 0x08720001}, {0xc78, 0x07730001},
972         {0xc78, 0x06740001}, {0xc78, 0x05750001},
973         {0xc78, 0x04760001}, {0xc78, 0x03770001},
974         {0xc78, 0x02780001}, {0xc78, 0x01790001},
975         {0xc78, 0x017a0001}, {0xc78, 0x017b0001},
976         {0xc78, 0x017c0001}, {0xc78, 0x017d0001},
977         {0xc78, 0x017e0001}, {0xc78, 0x017f0001},
978         {0xc50, 0x69553422},
979         {0xc50, 0x69553420},
980         {0x824, 0x00390204},
981         {0xffff, 0xffffffff}
982 };
983
984 static struct rtl8xxxu_reg32val rtl8xxx_agc_8192eu_std_table[] = {
985         {0xc78, 0xfb000001}, {0xc78, 0xfb010001},
986         {0xc78, 0xfb020001}, {0xc78, 0xfb030001},
987         {0xc78, 0xfb040001}, {0xc78, 0xfb050001},
988         {0xc78, 0xfa060001}, {0xc78, 0xf9070001},
989         {0xc78, 0xf8080001}, {0xc78, 0xf7090001},
990         {0xc78, 0xf60a0001}, {0xc78, 0xf50b0001},
991         {0xc78, 0xf40c0001}, {0xc78, 0xf30d0001},
992         {0xc78, 0xf20e0001}, {0xc78, 0xf10f0001},
993         {0xc78, 0xf0100001}, {0xc78, 0xef110001},
994         {0xc78, 0xee120001}, {0xc78, 0xed130001},
995         {0xc78, 0xec140001}, {0xc78, 0xeb150001},
996         {0xc78, 0xea160001}, {0xc78, 0xe9170001},
997         {0xc78, 0xe8180001}, {0xc78, 0xe7190001},
998         {0xc78, 0xc81a0001}, {0xc78, 0xc71b0001},
999         {0xc78, 0xc61c0001}, {0xc78, 0x071d0001},
1000         {0xc78, 0x061e0001}, {0xc78, 0x051f0001},
1001         {0xc78, 0x04200001}, {0xc78, 0x03210001},
1002         {0xc78, 0xaa220001}, {0xc78, 0xa9230001},
1003         {0xc78, 0xa8240001}, {0xc78, 0xa7250001},
1004         {0xc78, 0xa6260001}, {0xc78, 0x85270001},
1005         {0xc78, 0x84280001}, {0xc78, 0x83290001},
1006         {0xc78, 0x252a0001}, {0xc78, 0x242b0001},
1007         {0xc78, 0x232c0001}, {0xc78, 0x222d0001},
1008         {0xc78, 0x672e0001}, {0xc78, 0x662f0001},
1009         {0xc78, 0x65300001}, {0xc78, 0x64310001},
1010         {0xc78, 0x63320001}, {0xc78, 0x62330001},
1011         {0xc78, 0x61340001}, {0xc78, 0x45350001},
1012         {0xc78, 0x44360001}, {0xc78, 0x43370001},
1013         {0xc78, 0x42380001}, {0xc78, 0x41390001},
1014         {0xc78, 0x403a0001}, {0xc78, 0x403b0001},
1015         {0xc78, 0x403c0001}, {0xc78, 0x403d0001},
1016         {0xc78, 0x403e0001}, {0xc78, 0x403f0001},
1017         {0xc78, 0xfb400001}, {0xc78, 0xfb410001},
1018         {0xc78, 0xfb420001}, {0xc78, 0xfb430001},
1019         {0xc78, 0xfb440001}, {0xc78, 0xfb450001},
1020         {0xc78, 0xfa460001}, {0xc78, 0xf9470001},
1021         {0xc78, 0xf8480001}, {0xc78, 0xf7490001},
1022         {0xc78, 0xf64a0001}, {0xc78, 0xf54b0001},
1023         {0xc78, 0xf44c0001}, {0xc78, 0xf34d0001},
1024         {0xc78, 0xf24e0001}, {0xc78, 0xf14f0001},
1025         {0xc78, 0xf0500001}, {0xc78, 0xef510001},
1026         {0xc78, 0xee520001}, {0xc78, 0xed530001},
1027         {0xc78, 0xec540001}, {0xc78, 0xeb550001},
1028         {0xc78, 0xea560001}, {0xc78, 0xe9570001},
1029         {0xc78, 0xe8580001}, {0xc78, 0xe7590001},
1030         {0xc78, 0xe65a0001}, {0xc78, 0xe55b0001},
1031         {0xc78, 0xe45c0001}, {0xc78, 0xe35d0001},
1032         {0xc78, 0xe25e0001}, {0xc78, 0xe15f0001},
1033         {0xc78, 0x8a600001}, {0xc78, 0x89610001},
1034         {0xc78, 0x88620001}, {0xc78, 0x87630001},
1035         {0xc78, 0x86640001}, {0xc78, 0x85650001},
1036         {0xc78, 0x84660001}, {0xc78, 0x83670001},
1037         {0xc78, 0x82680001}, {0xc78, 0x6b690001},
1038         {0xc78, 0x6a6a0001}, {0xc78, 0x696b0001},
1039         {0xc78, 0x686c0001}, {0xc78, 0x676d0001},
1040         {0xc78, 0x666e0001}, {0xc78, 0x656f0001},
1041         {0xc78, 0x64700001}, {0xc78, 0x63710001},
1042         {0xc78, 0x62720001}, {0xc78, 0x61730001},
1043         {0xc78, 0x49740001}, {0xc78, 0x48750001},
1044         {0xc78, 0x47760001}, {0xc78, 0x46770001},
1045         {0xc78, 0x45780001}, {0xc78, 0x44790001},
1046         {0xc78, 0x437a0001}, {0xc78, 0x427b0001},
1047         {0xc78, 0x417c0001}, {0xc78, 0x407d0001},
1048         {0xc78, 0x407e0001}, {0xc78, 0x407f0001},
1049         {0xc50, 0x00040022}, {0xc50, 0x00040020},
1050         {0xffff, 0xffffffff}
1051 };
1052
1053 static struct rtl8xxxu_reg32val rtl8xxx_agc_8192eu_highpa_table[] = {
1054         {0xc78, 0xfa000001}, {0xc78, 0xf9010001},
1055         {0xc78, 0xf8020001}, {0xc78, 0xf7030001},
1056         {0xc78, 0xf6040001}, {0xc78, 0xf5050001},
1057         {0xc78, 0xf4060001}, {0xc78, 0xf3070001},
1058         {0xc78, 0xf2080001}, {0xc78, 0xf1090001},
1059         {0xc78, 0xf00a0001}, {0xc78, 0xef0b0001},
1060         {0xc78, 0xee0c0001}, {0xc78, 0xed0d0001},
1061         {0xc78, 0xec0e0001}, {0xc78, 0xeb0f0001},
1062         {0xc78, 0xea100001}, {0xc78, 0xe9110001},
1063         {0xc78, 0xe8120001}, {0xc78, 0xe7130001},
1064         {0xc78, 0xe6140001}, {0xc78, 0xe5150001},
1065         {0xc78, 0xe4160001}, {0xc78, 0xe3170001},
1066         {0xc78, 0xe2180001}, {0xc78, 0xe1190001},
1067         {0xc78, 0x8a1a0001}, {0xc78, 0x891b0001},
1068         {0xc78, 0x881c0001}, {0xc78, 0x871d0001},
1069         {0xc78, 0x861e0001}, {0xc78, 0x851f0001},
1070         {0xc78, 0x84200001}, {0xc78, 0x83210001},
1071         {0xc78, 0x82220001}, {0xc78, 0x6a230001},
1072         {0xc78, 0x69240001}, {0xc78, 0x68250001},
1073         {0xc78, 0x67260001}, {0xc78, 0x66270001},
1074         {0xc78, 0x65280001}, {0xc78, 0x64290001},
1075         {0xc78, 0x632a0001}, {0xc78, 0x622b0001},
1076         {0xc78, 0x612c0001}, {0xc78, 0x602d0001},
1077         {0xc78, 0x472e0001}, {0xc78, 0x462f0001},
1078         {0xc78, 0x45300001}, {0xc78, 0x44310001},
1079         {0xc78, 0x43320001}, {0xc78, 0x42330001},
1080         {0xc78, 0x41340001}, {0xc78, 0x40350001},
1081         {0xc78, 0x40360001}, {0xc78, 0x40370001},
1082         {0xc78, 0x40380001}, {0xc78, 0x40390001},
1083         {0xc78, 0x403a0001}, {0xc78, 0x403b0001},
1084         {0xc78, 0x403c0001}, {0xc78, 0x403d0001},
1085         {0xc78, 0x403e0001}, {0xc78, 0x403f0001},
1086         {0xc78, 0xfa400001}, {0xc78, 0xf9410001},
1087         {0xc78, 0xf8420001}, {0xc78, 0xf7430001},
1088         {0xc78, 0xf6440001}, {0xc78, 0xf5450001},
1089         {0xc78, 0xf4460001}, {0xc78, 0xf3470001},
1090         {0xc78, 0xf2480001}, {0xc78, 0xf1490001},
1091         {0xc78, 0xf04a0001}, {0xc78, 0xef4b0001},
1092         {0xc78, 0xee4c0001}, {0xc78, 0xed4d0001},
1093         {0xc78, 0xec4e0001}, {0xc78, 0xeb4f0001},
1094         {0xc78, 0xea500001}, {0xc78, 0xe9510001},
1095         {0xc78, 0xe8520001}, {0xc78, 0xe7530001},
1096         {0xc78, 0xe6540001}, {0xc78, 0xe5550001},
1097         {0xc78, 0xe4560001}, {0xc78, 0xe3570001},
1098         {0xc78, 0xe2580001}, {0xc78, 0xe1590001},
1099         {0xc78, 0x8a5a0001}, {0xc78, 0x895b0001},
1100         {0xc78, 0x885c0001}, {0xc78, 0x875d0001},
1101         {0xc78, 0x865e0001}, {0xc78, 0x855f0001},
1102         {0xc78, 0x84600001}, {0xc78, 0x83610001},
1103         {0xc78, 0x82620001}, {0xc78, 0x6a630001},
1104         {0xc78, 0x69640001}, {0xc78, 0x68650001},
1105         {0xc78, 0x67660001}, {0xc78, 0x66670001},
1106         {0xc78, 0x65680001}, {0xc78, 0x64690001},
1107         {0xc78, 0x636a0001}, {0xc78, 0x626b0001},
1108         {0xc78, 0x616c0001}, {0xc78, 0x606d0001},
1109         {0xc78, 0x476e0001}, {0xc78, 0x466f0001},
1110         {0xc78, 0x45700001}, {0xc78, 0x44710001},
1111         {0xc78, 0x43720001}, {0xc78, 0x42730001},
1112         {0xc78, 0x41740001}, {0xc78, 0x40750001},
1113         {0xc78, 0x40760001}, {0xc78, 0x40770001},
1114         {0xc78, 0x40780001}, {0xc78, 0x40790001},
1115         {0xc78, 0x407a0001}, {0xc78, 0x407b0001},
1116         {0xc78, 0x407c0001}, {0xc78, 0x407d0001},
1117         {0xc78, 0x407e0001}, {0xc78, 0x407f0001},
1118         {0xc50, 0x00040222}, {0xc50, 0x00040220},
1119         {0xffff, 0xffffffff}
1120 };
1121
1122 static struct rtl8xxxu_rfregval rtl8723au_radioa_1t_init_table[] = {
1123         {0x00, 0x00030159}, {0x01, 0x00031284},
1124         {0x02, 0x00098000}, {0x03, 0x00039c63},
1125         {0x04, 0x000210e7}, {0x09, 0x0002044f},
1126         {0x0a, 0x0001a3f1}, {0x0b, 0x00014787},
1127         {0x0c, 0x000896fe}, {0x0d, 0x0000e02c},
1128         {0x0e, 0x00039ce7}, {0x0f, 0x00000451},
1129         {0x19, 0x00000000}, {0x1a, 0x00030355},
1130         {0x1b, 0x00060a00}, {0x1c, 0x000fc378},
1131         {0x1d, 0x000a1250}, {0x1e, 0x0000024f},
1132         {0x1f, 0x00000000}, {0x20, 0x0000b614},
1133         {0x21, 0x0006c000}, {0x22, 0x00000000},
1134         {0x23, 0x00001558}, {0x24, 0x00000060},
1135         {0x25, 0x00000483}, {0x26, 0x0004f000},
1136         {0x27, 0x000ec7d9}, {0x28, 0x00057730},
1137         {0x29, 0x00004783}, {0x2a, 0x00000001},
1138         {0x2b, 0x00021334}, {0x2a, 0x00000000},
1139         {0x2b, 0x00000054}, {0x2a, 0x00000001},
1140         {0x2b, 0x00000808}, {0x2b, 0x00053333},
1141         {0x2c, 0x0000000c}, {0x2a, 0x00000002},
1142         {0x2b, 0x00000808}, {0x2b, 0x0005b333},
1143         {0x2c, 0x0000000d}, {0x2a, 0x00000003},
1144         {0x2b, 0x00000808}, {0x2b, 0x00063333},
1145         {0x2c, 0x0000000d}, {0x2a, 0x00000004},
1146         {0x2b, 0x00000808}, {0x2b, 0x0006b333},
1147         {0x2c, 0x0000000d}, {0x2a, 0x00000005},
1148         {0x2b, 0x00000808}, {0x2b, 0x00073333},
1149         {0x2c, 0x0000000d}, {0x2a, 0x00000006},
1150         {0x2b, 0x00000709}, {0x2b, 0x0005b333},
1151         {0x2c, 0x0000000d}, {0x2a, 0x00000007},
1152         {0x2b, 0x00000709}, {0x2b, 0x00063333},
1153         {0x2c, 0x0000000d}, {0x2a, 0x00000008},
1154         {0x2b, 0x0000060a}, {0x2b, 0x0004b333},
1155         {0x2c, 0x0000000d}, {0x2a, 0x00000009},
1156         {0x2b, 0x0000060a}, {0x2b, 0x00053333},
1157         {0x2c, 0x0000000d}, {0x2a, 0x0000000a},
1158         {0x2b, 0x0000060a}, {0x2b, 0x0005b333},
1159         {0x2c, 0x0000000d}, {0x2a, 0x0000000b},
1160         {0x2b, 0x0000060a}, {0x2b, 0x00063333},
1161         {0x2c, 0x0000000d}, {0x2a, 0x0000000c},
1162         {0x2b, 0x0000060a}, {0x2b, 0x0006b333},
1163         {0x2c, 0x0000000d}, {0x2a, 0x0000000d},
1164         {0x2b, 0x0000060a}, {0x2b, 0x00073333},
1165         {0x2c, 0x0000000d}, {0x2a, 0x0000000e},
1166         {0x2b, 0x0000050b}, {0x2b, 0x00066666},
1167         {0x2c, 0x0000001a}, {0x2a, 0x000e0000},
1168         {0x10, 0x0004000f}, {0x11, 0x000e31fc},
1169         {0x10, 0x0006000f}, {0x11, 0x000ff9f8},
1170         {0x10, 0x0002000f}, {0x11, 0x000203f9},
1171         {0x10, 0x0003000f}, {0x11, 0x000ff500},
1172         {0x10, 0x00000000}, {0x11, 0x00000000},
1173         {0x10, 0x0008000f}, {0x11, 0x0003f100},
1174         {0x10, 0x0009000f}, {0x11, 0x00023100},
1175         {0x12, 0x00032000}, {0x12, 0x00071000},
1176         {0x12, 0x000b0000}, {0x12, 0x000fc000},
1177         {0x13, 0x000287b3}, {0x13, 0x000244b7},
1178         {0x13, 0x000204ab}, {0x13, 0x0001c49f},
1179         {0x13, 0x00018493}, {0x13, 0x0001429b},
1180         {0x13, 0x00010299}, {0x13, 0x0000c29c},
1181         {0x13, 0x000081a0}, {0x13, 0x000040ac},
1182         {0x13, 0x00000020}, {0x14, 0x0001944c},
1183         {0x14, 0x00059444}, {0x14, 0x0009944c},
1184         {0x14, 0x000d9444}, {0x15, 0x0000f474},
1185         {0x15, 0x0004f477}, {0x15, 0x0008f455},
1186         {0x15, 0x000cf455}, {0x16, 0x00000339},
1187         {0x16, 0x00040339}, {0x16, 0x00080339},
1188         {0x16, 0x000c0366}, {0x00, 0x00010159},
1189         {0x18, 0x0000f401}, {0xfe, 0x00000000},
1190         {0xfe, 0x00000000}, {0x1f, 0x00000003},
1191         {0xfe, 0x00000000}, {0xfe, 0x00000000},
1192         {0x1e, 0x00000247}, {0x1f, 0x00000000},
1193         {0x00, 0x00030159},
1194         {0xff, 0xffffffff}
1195 };
1196
1197 static struct rtl8xxxu_rfregval rtl8723bu_radioa_1t_init_table[] = {
1198         {0x00, 0x00010000}, {0xb0, 0x000dffe0},
1199         {0xfe, 0x00000000}, {0xfe, 0x00000000},
1200         {0xfe, 0x00000000}, {0xb1, 0x00000018},
1201         {0xfe, 0x00000000}, {0xfe, 0x00000000},
1202         {0xfe, 0x00000000}, {0xb2, 0x00084c00},
1203         {0xb5, 0x0000d2cc}, {0xb6, 0x000925aa},
1204         {0xb7, 0x00000010}, {0xb8, 0x0000907f},
1205         {0x5c, 0x00000002}, {0x7c, 0x00000002},
1206         {0x7e, 0x00000005}, {0x8b, 0x0006fc00},
1207         {0xb0, 0x000ff9f0}, {0x1c, 0x000739d2},
1208         {0x1e, 0x00000000}, {0xdf, 0x00000780},
1209         {0x50, 0x00067435},
1210         /*
1211          * The 8723bu vendor driver indicates that bit 8 should be set in
1212          * 0x51 for package types TFBGA90, TFBGA80, and TFBGA79. However
1213          * they never actually check the package type - and just default
1214          * to not setting it.
1215          */
1216         {0x51, 0x0006b04e},
1217         {0x52, 0x000007d2}, {0x53, 0x00000000},
1218         {0x54, 0x00050400}, {0x55, 0x0004026e},
1219         {0xdd, 0x0000004c}, {0x70, 0x00067435},
1220         /*
1221          * 0x71 has same package type condition as for register 0x51
1222          */
1223         {0x71, 0x0006b04e},
1224         {0x72, 0x000007d2}, {0x73, 0x00000000},
1225         {0x74, 0x00050400}, {0x75, 0x0004026e},
1226         {0xef, 0x00000100}, {0x34, 0x0000add7},
1227         {0x35, 0x00005c00}, {0x34, 0x00009dd4},
1228         {0x35, 0x00005000}, {0x34, 0x00008dd1},
1229         {0x35, 0x00004400}, {0x34, 0x00007dce},
1230         {0x35, 0x00003800}, {0x34, 0x00006cd1},
1231         {0x35, 0x00004400}, {0x34, 0x00005cce},
1232         {0x35, 0x00003800}, {0x34, 0x000048ce},
1233         {0x35, 0x00004400}, {0x34, 0x000034ce},
1234         {0x35, 0x00003800}, {0x34, 0x00002451},
1235         {0x35, 0x00004400}, {0x34, 0x0000144e},
1236         {0x35, 0x00003800}, {0x34, 0x00000051},
1237         {0x35, 0x00004400}, {0xef, 0x00000000},
1238         {0xef, 0x00000100}, {0xed, 0x00000010},
1239         {0x44, 0x0000add7}, {0x44, 0x00009dd4},
1240         {0x44, 0x00008dd1}, {0x44, 0x00007dce},
1241         {0x44, 0x00006cc1}, {0x44, 0x00005cce},
1242         {0x44, 0x000044d1}, {0x44, 0x000034ce},
1243         {0x44, 0x00002451}, {0x44, 0x0000144e},
1244         {0x44, 0x00000051}, {0xef, 0x00000000},
1245         {0xed, 0x00000000}, {0x7f, 0x00020080},
1246         {0xef, 0x00002000}, {0x3b, 0x000380ef},
1247         {0x3b, 0x000302fe}, {0x3b, 0x00028ce6},
1248         {0x3b, 0x000200bc}, {0x3b, 0x000188a5},
1249         {0x3b, 0x00010fbc}, {0x3b, 0x00008f71},
1250         {0x3b, 0x00000900}, {0xef, 0x00000000},
1251         {0xed, 0x00000001}, {0x40, 0x000380ef},
1252         {0x40, 0x000302fe}, {0x40, 0x00028ce6},
1253         {0x40, 0x000200bc}, {0x40, 0x000188a5},
1254         {0x40, 0x00010fbc}, {0x40, 0x00008f71},
1255         {0x40, 0x00000900}, {0xed, 0x00000000},
1256         {0x82, 0x00080000}, {0x83, 0x00008000},
1257         {0x84, 0x00048d80}, {0x85, 0x00068000},
1258         {0xa2, 0x00080000}, {0xa3, 0x00008000},
1259         {0xa4, 0x00048d80}, {0xa5, 0x00068000},
1260         {0xed, 0x00000002}, {0xef, 0x00000002},
1261         {0x56, 0x00000032}, {0x76, 0x00000032},
1262         {0x01, 0x00000780},
1263         {0xff, 0xffffffff}
1264 };
1265
1266 static struct rtl8xxxu_rfregval rtl8192cu_radioa_2t_init_table[] = {
1267         {0x00, 0x00030159}, {0x01, 0x00031284},
1268         {0x02, 0x00098000}, {0x03, 0x00018c63},
1269         {0x04, 0x000210e7}, {0x09, 0x0002044f},
1270         {0x0a, 0x0001adb1}, {0x0b, 0x00054867},
1271         {0x0c, 0x0008992e}, {0x0d, 0x0000e52c},
1272         {0x0e, 0x00039ce7}, {0x0f, 0x00000451},
1273         {0x19, 0x00000000}, {0x1a, 0x00010255},
1274         {0x1b, 0x00060a00}, {0x1c, 0x000fc378},
1275         {0x1d, 0x000a1250}, {0x1e, 0x0004445f},
1276         {0x1f, 0x00080001}, {0x20, 0x0000b614},
1277         {0x21, 0x0006c000}, {0x22, 0x00000000},
1278         {0x23, 0x00001558}, {0x24, 0x00000060},
1279         {0x25, 0x00000483}, {0x26, 0x0004f000},
1280         {0x27, 0x000ec7d9}, {0x28, 0x000577c0},
1281         {0x29, 0x00004783}, {0x2a, 0x00000001},
1282         {0x2b, 0x00021334}, {0x2a, 0x00000000},
1283         {0x2b, 0x00000054}, {0x2a, 0x00000001},
1284         {0x2b, 0x00000808}, {0x2b, 0x00053333},
1285         {0x2c, 0x0000000c}, {0x2a, 0x00000002},
1286         {0x2b, 0x00000808}, {0x2b, 0x0005b333},
1287         {0x2c, 0x0000000d}, {0x2a, 0x00000003},
1288         {0x2b, 0x00000808}, {0x2b, 0x00063333},
1289         {0x2c, 0x0000000d}, {0x2a, 0x00000004},
1290         {0x2b, 0x00000808}, {0x2b, 0x0006b333},
1291         {0x2c, 0x0000000d}, {0x2a, 0x00000005},
1292         {0x2b, 0x00000808}, {0x2b, 0x00073333},
1293         {0x2c, 0x0000000d}, {0x2a, 0x00000006},
1294         {0x2b, 0x00000709}, {0x2b, 0x0005b333},
1295         {0x2c, 0x0000000d}, {0x2a, 0x00000007},
1296         {0x2b, 0x00000709}, {0x2b, 0x00063333},
1297         {0x2c, 0x0000000d}, {0x2a, 0x00000008},
1298         {0x2b, 0x0000060a}, {0x2b, 0x0004b333},
1299         {0x2c, 0x0000000d}, {0x2a, 0x00000009},
1300         {0x2b, 0x0000060a}, {0x2b, 0x00053333},
1301         {0x2c, 0x0000000d}, {0x2a, 0x0000000a},
1302         {0x2b, 0x0000060a}, {0x2b, 0x0005b333},
1303         {0x2c, 0x0000000d}, {0x2a, 0x0000000b},
1304         {0x2b, 0x0000060a}, {0x2b, 0x00063333},
1305         {0x2c, 0x0000000d}, {0x2a, 0x0000000c},
1306         {0x2b, 0x0000060a}, {0x2b, 0x0006b333},
1307         {0x2c, 0x0000000d}, {0x2a, 0x0000000d},
1308         {0x2b, 0x0000060a}, {0x2b, 0x00073333},
1309         {0x2c, 0x0000000d}, {0x2a, 0x0000000e},
1310         {0x2b, 0x0000050b}, {0x2b, 0x00066666},
1311         {0x2c, 0x0000001a}, {0x2a, 0x000e0000},
1312         {0x10, 0x0004000f}, {0x11, 0x000e31fc},
1313         {0x10, 0x0006000f}, {0x11, 0x000ff9f8},
1314         {0x10, 0x0002000f}, {0x11, 0x000203f9},
1315         {0x10, 0x0003000f}, {0x11, 0x000ff500},
1316         {0x10, 0x00000000}, {0x11, 0x00000000},
1317         {0x10, 0x0008000f}, {0x11, 0x0003f100},
1318         {0x10, 0x0009000f}, {0x11, 0x00023100},
1319         {0x12, 0x00032000}, {0x12, 0x00071000},
1320         {0x12, 0x000b0000}, {0x12, 0x000fc000},
1321         {0x13, 0x000287b3}, {0x13, 0x000244b7},
1322         {0x13, 0x000204ab}, {0x13, 0x0001c49f},
1323         {0x13, 0x00018493}, {0x13, 0x0001429b},
1324         {0x13, 0x00010299}, {0x13, 0x0000c29c},
1325         {0x13, 0x000081a0}, {0x13, 0x000040ac},
1326         {0x13, 0x00000020}, {0x14, 0x0001944c},
1327         {0x14, 0x00059444}, {0x14, 0x0009944c},
1328         {0x14, 0x000d9444}, {0x15, 0x0000f424},
1329         {0x15, 0x0004f424}, {0x15, 0x0008f424},
1330         {0x15, 0x000cf424}, {0x16, 0x000e0330},
1331         {0x16, 0x000a0330}, {0x16, 0x00060330},
1332         {0x16, 0x00020330}, {0x00, 0x00010159},
1333         {0x18, 0x0000f401}, {0xfe, 0x00000000},
1334         {0xfe, 0x00000000}, {0x1f, 0x00080003},
1335         {0xfe, 0x00000000}, {0xfe, 0x00000000},
1336         {0x1e, 0x00044457}, {0x1f, 0x00080000},
1337         {0x00, 0x00030159},
1338         {0xff, 0xffffffff}
1339 };
1340
1341 static struct rtl8xxxu_rfregval rtl8192cu_radiob_2t_init_table[] = {
1342         {0x00, 0x00030159}, {0x01, 0x00031284},
1343         {0x02, 0x00098000}, {0x03, 0x00018c63},
1344         {0x04, 0x000210e7}, {0x09, 0x0002044f},
1345         {0x0a, 0x0001adb1}, {0x0b, 0x00054867},
1346         {0x0c, 0x0008992e}, {0x0d, 0x0000e52c},
1347         {0x0e, 0x00039ce7}, {0x0f, 0x00000451},
1348         {0x12, 0x00032000}, {0x12, 0x00071000},
1349         {0x12, 0x000b0000}, {0x12, 0x000fc000},
1350         {0x13, 0x000287af}, {0x13, 0x000244b7},
1351         {0x13, 0x000204ab}, {0x13, 0x0001c49f},
1352         {0x13, 0x00018493}, {0x13, 0x00014297},
1353         {0x13, 0x00010295}, {0x13, 0x0000c298},
1354         {0x13, 0x0000819c}, {0x13, 0x000040a8},
1355         {0x13, 0x0000001c}, {0x14, 0x0001944c},
1356         {0x14, 0x00059444}, {0x14, 0x0009944c},
1357         {0x14, 0x000d9444}, {0x15, 0x0000f424},
1358         {0x15, 0x0004f424}, {0x15, 0x0008f424},
1359         {0x15, 0x000cf424}, {0x16, 0x000e0330},
1360         {0x16, 0x000a0330}, {0x16, 0x00060330},
1361         {0x16, 0x00020330},
1362         {0xff, 0xffffffff}
1363 };
1364
1365 static struct rtl8xxxu_rfregval rtl8192cu_radioa_1t_init_table[] = {
1366         {0x00, 0x00030159}, {0x01, 0x00031284},
1367         {0x02, 0x00098000}, {0x03, 0x00018c63},
1368         {0x04, 0x000210e7}, {0x09, 0x0002044f},
1369         {0x0a, 0x0001adb1}, {0x0b, 0x00054867},
1370         {0x0c, 0x0008992e}, {0x0d, 0x0000e52c},
1371         {0x0e, 0x00039ce7}, {0x0f, 0x00000451},
1372         {0x19, 0x00000000}, {0x1a, 0x00010255},
1373         {0x1b, 0x00060a00}, {0x1c, 0x000fc378},
1374         {0x1d, 0x000a1250}, {0x1e, 0x0004445f},
1375         {0x1f, 0x00080001}, {0x20, 0x0000b614},
1376         {0x21, 0x0006c000}, {0x22, 0x00000000},
1377         {0x23, 0x00001558}, {0x24, 0x00000060},
1378         {0x25, 0x00000483}, {0x26, 0x0004f000},
1379         {0x27, 0x000ec7d9}, {0x28, 0x000577c0},
1380         {0x29, 0x00004783}, {0x2a, 0x00000001},
1381         {0x2b, 0x00021334}, {0x2a, 0x00000000},
1382         {0x2b, 0x00000054}, {0x2a, 0x00000001},
1383         {0x2b, 0x00000808}, {0x2b, 0x00053333},
1384         {0x2c, 0x0000000c}, {0x2a, 0x00000002},
1385         {0x2b, 0x00000808}, {0x2b, 0x0005b333},
1386         {0x2c, 0x0000000d}, {0x2a, 0x00000003},
1387         {0x2b, 0x00000808}, {0x2b, 0x00063333},
1388         {0x2c, 0x0000000d}, {0x2a, 0x00000004},
1389         {0x2b, 0x00000808}, {0x2b, 0x0006b333},
1390         {0x2c, 0x0000000d}, {0x2a, 0x00000005},
1391         {0x2b, 0x00000808}, {0x2b, 0x00073333},
1392         {0x2c, 0x0000000d}, {0x2a, 0x00000006},
1393         {0x2b, 0x00000709}, {0x2b, 0x0005b333},
1394         {0x2c, 0x0000000d}, {0x2a, 0x00000007},
1395         {0x2b, 0x00000709}, {0x2b, 0x00063333},
1396         {0x2c, 0x0000000d}, {0x2a, 0x00000008},
1397         {0x2b, 0x0000060a}, {0x2b, 0x0004b333},
1398         {0x2c, 0x0000000d}, {0x2a, 0x00000009},
1399         {0x2b, 0x0000060a}, {0x2b, 0x00053333},
1400         {0x2c, 0x0000000d}, {0x2a, 0x0000000a},
1401         {0x2b, 0x0000060a}, {0x2b, 0x0005b333},
1402         {0x2c, 0x0000000d}, {0x2a, 0x0000000b},
1403         {0x2b, 0x0000060a}, {0x2b, 0x00063333},
1404         {0x2c, 0x0000000d}, {0x2a, 0x0000000c},
1405         {0x2b, 0x0000060a}, {0x2b, 0x0006b333},
1406         {0x2c, 0x0000000d}, {0x2a, 0x0000000d},
1407         {0x2b, 0x0000060a}, {0x2b, 0x00073333},
1408         {0x2c, 0x0000000d}, {0x2a, 0x0000000e},
1409         {0x2b, 0x0000050b}, {0x2b, 0x00066666},
1410         {0x2c, 0x0000001a}, {0x2a, 0x000e0000},
1411         {0x10, 0x0004000f}, {0x11, 0x000e31fc},
1412         {0x10, 0x0006000f}, {0x11, 0x000ff9f8},
1413         {0x10, 0x0002000f}, {0x11, 0x000203f9},
1414         {0x10, 0x0003000f}, {0x11, 0x000ff500},
1415         {0x10, 0x00000000}, {0x11, 0x00000000},
1416         {0x10, 0x0008000f}, {0x11, 0x0003f100},
1417         {0x10, 0x0009000f}, {0x11, 0x00023100},
1418         {0x12, 0x00032000}, {0x12, 0x00071000},
1419         {0x12, 0x000b0000}, {0x12, 0x000fc000},
1420         {0x13, 0x000287b3}, {0x13, 0x000244b7},
1421         {0x13, 0x000204ab}, {0x13, 0x0001c49f},
1422         {0x13, 0x00018493}, {0x13, 0x0001429b},
1423         {0x13, 0x00010299}, {0x13, 0x0000c29c},
1424         {0x13, 0x000081a0}, {0x13, 0x000040ac},
1425         {0x13, 0x00000020}, {0x14, 0x0001944c},
1426         {0x14, 0x00059444}, {0x14, 0x0009944c},
1427         {0x14, 0x000d9444}, {0x15, 0x0000f405},
1428         {0x15, 0x0004f405}, {0x15, 0x0008f405},
1429         {0x15, 0x000cf405}, {0x16, 0x000e0330},
1430         {0x16, 0x000a0330}, {0x16, 0x00060330},
1431         {0x16, 0x00020330}, {0x00, 0x00010159},
1432         {0x18, 0x0000f401}, {0xfe, 0x00000000},
1433         {0xfe, 0x00000000}, {0x1f, 0x00080003},
1434         {0xfe, 0x00000000}, {0xfe, 0x00000000},
1435         {0x1e, 0x00044457}, {0x1f, 0x00080000},
1436         {0x00, 0x00030159},
1437         {0xff, 0xffffffff}
1438 };
1439
1440 static struct rtl8xxxu_rfregval rtl8188ru_radioa_1t_highpa_table[] = {
1441         {0x00, 0x00030159}, {0x01, 0x00031284},
1442         {0x02, 0x00098000}, {0x03, 0x00018c63},
1443         {0x04, 0x000210e7}, {0x09, 0x0002044f},
1444         {0x0a, 0x0001adb0}, {0x0b, 0x00054867},
1445         {0x0c, 0x0008992e}, {0x0d, 0x0000e529},
1446         {0x0e, 0x00039ce7}, {0x0f, 0x00000451},
1447         {0x19, 0x00000000}, {0x1a, 0x00000255},
1448         {0x1b, 0x00060a00}, {0x1c, 0x000fc378},
1449         {0x1d, 0x000a1250}, {0x1e, 0x0004445f},
1450         {0x1f, 0x00080001}, {0x20, 0x0000b614},
1451         {0x21, 0x0006c000}, {0x22, 0x0000083c},
1452         {0x23, 0x00001558}, {0x24, 0x00000060},
1453         {0x25, 0x00000483}, {0x26, 0x0004f000},
1454         {0x27, 0x000ec7d9}, {0x28, 0x000977c0},
1455         {0x29, 0x00004783}, {0x2a, 0x00000001},
1456         {0x2b, 0x00021334}, {0x2a, 0x00000000},
1457         {0x2b, 0x00000054}, {0x2a, 0x00000001},
1458         {0x2b, 0x00000808}, {0x2b, 0x00053333},
1459         {0x2c, 0x0000000c}, {0x2a, 0x00000002},
1460         {0x2b, 0x00000808}, {0x2b, 0x0005b333},
1461         {0x2c, 0x0000000d}, {0x2a, 0x00000003},
1462         {0x2b, 0x00000808}, {0x2b, 0x00063333},
1463         {0x2c, 0x0000000d}, {0x2a, 0x00000004},
1464         {0x2b, 0x00000808}, {0x2b, 0x0006b333},
1465         {0x2c, 0x0000000d}, {0x2a, 0x00000005},
1466         {0x2b, 0x00000808}, {0x2b, 0x00073333},
1467         {0x2c, 0x0000000d}, {0x2a, 0x00000006},
1468         {0x2b, 0x00000709}, {0x2b, 0x0005b333},
1469         {0x2c, 0x0000000d}, {0x2a, 0x00000007},
1470         {0x2b, 0x00000709}, {0x2b, 0x00063333},
1471         {0x2c, 0x0000000d}, {0x2a, 0x00000008},
1472         {0x2b, 0x0000060a}, {0x2b, 0x0004b333},
1473         {0x2c, 0x0000000d}, {0x2a, 0x00000009},
1474         {0x2b, 0x0000060a}, {0x2b, 0x00053333},
1475         {0x2c, 0x0000000d}, {0x2a, 0x0000000a},
1476         {0x2b, 0x0000060a}, {0x2b, 0x0005b333},
1477         {0x2c, 0x0000000d}, {0x2a, 0x0000000b},
1478         {0x2b, 0x0000060a}, {0x2b, 0x00063333},
1479         {0x2c, 0x0000000d}, {0x2a, 0x0000000c},
1480         {0x2b, 0x0000060a}, {0x2b, 0x0006b333},
1481         {0x2c, 0x0000000d}, {0x2a, 0x0000000d},
1482         {0x2b, 0x0000060a}, {0x2b, 0x00073333},
1483         {0x2c, 0x0000000d}, {0x2a, 0x0000000e},
1484         {0x2b, 0x0000050b}, {0x2b, 0x00066666},
1485         {0x2c, 0x0000001a}, {0x2a, 0x000e0000},
1486         {0x10, 0x0004000f}, {0x11, 0x000e31fc},
1487         {0x10, 0x0006000f}, {0x11, 0x000ff9f8},
1488         {0x10, 0x0002000f}, {0x11, 0x000203f9},
1489         {0x10, 0x0003000f}, {0x11, 0x000ff500},
1490         {0x10, 0x00000000}, {0x11, 0x00000000},
1491         {0x10, 0x0008000f}, {0x11, 0x0003f100},
1492         {0x10, 0x0009000f}, {0x11, 0x00023100},
1493         {0x12, 0x000d8000}, {0x12, 0x00090000},
1494         {0x12, 0x00051000}, {0x12, 0x00012000},
1495         {0x13, 0x00028fb4}, {0x13, 0x00024fa8},
1496         {0x13, 0x000207a4}, {0x13, 0x0001c3b0},
1497         {0x13, 0x000183a4}, {0x13, 0x00014398},
1498         {0x13, 0x000101a4}, {0x13, 0x0000c198},
1499         {0x13, 0x000080a4}, {0x13, 0x00004098},
1500         {0x13, 0x00000000}, {0x14, 0x0001944c},
1501         {0x14, 0x00059444}, {0x14, 0x0009944c},
1502         {0x14, 0x000d9444}, {0x15, 0x0000f405},
1503         {0x15, 0x0004f405}, {0x15, 0x0008f405},
1504         {0x15, 0x000cf405}, {0x16, 0x000e0330},
1505         {0x16, 0x000a0330}, {0x16, 0x00060330},
1506         {0x16, 0x00020330}, {0x00, 0x00010159},
1507         {0x18, 0x0000f401}, {0xfe, 0x00000000},
1508         {0xfe, 0x00000000}, {0x1f, 0x00080003},
1509         {0xfe, 0x00000000}, {0xfe, 0x00000000},
1510         {0x1e, 0x00044457}, {0x1f, 0x00080000},
1511         {0x00, 0x00030159},
1512         {0xff, 0xffffffff}
1513 };
1514
1515 static struct rtl8xxxu_rfregval rtl8192eu_radioa_init_table[] = {
1516         {0x7f, 0x00000082}, {0x81, 0x0003fc00},
1517         {0x00, 0x00030000}, {0x08, 0x00008400},
1518         {0x18, 0x00000407}, {0x19, 0x00000012},
1519         {0x1b, 0x00000064}, {0x1e, 0x00080009},
1520         {0x1f, 0x00000880}, {0x2f, 0x0001a060},
1521         {0x3f, 0x00000000}, {0x42, 0x000060c0},
1522         {0x57, 0x000d0000}, {0x58, 0x000be180},
1523         {0x67, 0x00001552}, {0x83, 0x00000000},
1524         {0xb0, 0x000ff9f1}, {0xb1, 0x00055418},
1525         {0xb2, 0x0008cc00}, {0xb4, 0x00043083},
1526         {0xb5, 0x00008166}, {0xb6, 0x0000803e},
1527         {0xb7, 0x0001c69f}, {0xb8, 0x0000407f},
1528         {0xb9, 0x00080001}, {0xba, 0x00040001},
1529         {0xbb, 0x00000400}, {0xbf, 0x000c0000},
1530         {0xc2, 0x00002400}, {0xc3, 0x00000009},
1531         {0xc4, 0x00040c91}, {0xc5, 0x00099999},
1532         {0xc6, 0x000000a3}, {0xc7, 0x00088820},
1533         {0xc8, 0x00076c06}, {0xc9, 0x00000000},
1534         {0xca, 0x00080000}, {0xdf, 0x00000180},
1535         {0xef, 0x000001a0}, {0x51, 0x00069545},
1536         {0x52, 0x0007e45e}, {0x53, 0x00000071},
1537         {0x56, 0x00051ff3}, {0x35, 0x000000a8},
1538         {0x35, 0x000001e2}, {0x35, 0x000002a8},
1539         {0x36, 0x00001c24}, {0x36, 0x00009c24},
1540         {0x36, 0x00011c24}, {0x36, 0x00019c24},
1541         {0x18, 0x00000c07}, {0x5a, 0x00048000},
1542         {0x19, 0x000739d0},
1543 #ifdef EXT_PA_8192EU
1544         /* External PA or external LNA */
1545         {0x34, 0x0000a093}, {0x34, 0x0000908f},
1546         {0x34, 0x0000808c}, {0x34, 0x0000704d},
1547         {0x34, 0x0000604a}, {0x34, 0x00005047},
1548         {0x34, 0x0000400a}, {0x34, 0x00003007},
1549         {0x34, 0x00002004}, {0x34, 0x00001001},
1550         {0x34, 0x00000000},
1551 #else
1552         /* Regular */
1553         {0x34, 0x0000add7}, {0x34, 0x00009dd4},
1554         {0x34, 0x00008dd1}, {0x34, 0x00007dce},
1555         {0x34, 0x00006dcb}, {0x34, 0x00005dc8},
1556         {0x34, 0x00004dc5}, {0x34, 0x000034cc},
1557         {0x34, 0x0000244f}, {0x34, 0x0000144c},
1558         {0x34, 0x00000014},
1559 #endif
1560         {0x00, 0x00030159},
1561         {0x84, 0x00068180},
1562         {0x86, 0x0000014e},
1563         {0x87, 0x00048e00},
1564         {0x8e, 0x00065540},
1565         {0x8f, 0x00088000},
1566         {0xef, 0x000020a0},
1567 #ifdef EXT_PA_8192EU
1568         /* External PA or external LNA */
1569         {0x3b, 0x000f07b0},
1570 #else
1571         {0x3b, 0x000f02b0},
1572 #endif
1573         {0x3b, 0x000ef7b0}, {0x3b, 0x000d4fb0},
1574         {0x3b, 0x000cf060}, {0x3b, 0x000b0090},
1575         {0x3b, 0x000a0080}, {0x3b, 0x00090080},
1576         {0x3b, 0x0008f780},
1577 #ifdef EXT_PA_8192EU
1578         /* External PA or external LNA */
1579         {0x3b, 0x000787b0},
1580 #else
1581         {0x3b, 0x00078730},
1582 #endif
1583         {0x3b, 0x00060fb0}, {0x3b, 0x0005ffa0},
1584         {0x3b, 0x00040620}, {0x3b, 0x00037090},
1585         {0x3b, 0x00020080}, {0x3b, 0x0001f060},
1586         {0x3b, 0x0000ffb0}, {0xef, 0x000000a0},
1587         {0xfe, 0x00000000}, {0x18, 0x0000fc07},
1588         {0xfe, 0x00000000}, {0xfe, 0x00000000},
1589         {0xfe, 0x00000000}, {0xfe, 0x00000000},
1590         {0x1e, 0x00000001}, {0x1f, 0x00080000},
1591         {0x00, 0x00033e70},
1592         {0xff, 0xffffffff}
1593 };
1594
1595 static struct rtl8xxxu_rfregval rtl8192eu_radiob_init_table[] = {
1596         {0x7f, 0x00000082}, {0x81, 0x0003fc00},
1597         {0x00, 0x00030000}, {0x08, 0x00008400},
1598         {0x18, 0x00000407}, {0x19, 0x00000012},
1599         {0x1b, 0x00000064}, {0x1e, 0x00080009},
1600         {0x1f, 0x00000880}, {0x2f, 0x0001a060},
1601         {0x3f, 0x00000000}, {0x42, 0x000060c0},
1602         {0x57, 0x000d0000}, {0x58, 0x000be180},
1603         {0x67, 0x00001552}, {0x7f, 0x00000082},
1604         {0x81, 0x0003f000}, {0x83, 0x00000000},
1605         {0xdf, 0x00000180}, {0xef, 0x000001a0},
1606         {0x51, 0x00069545}, {0x52, 0x0007e42e},
1607         {0x53, 0x00000071}, {0x56, 0x00051ff3},
1608         {0x35, 0x000000a8}, {0x35, 0x000001e0},
1609         {0x35, 0x000002a8}, {0x36, 0x00001ca8},
1610         {0x36, 0x00009c24}, {0x36, 0x00011c24},
1611         {0x36, 0x00019c24}, {0x18, 0x00000c07},
1612         {0x5a, 0x00048000}, {0x19, 0x000739d0},
1613 #ifdef EXT_PA_8192EU
1614         /* External PA or external LNA */
1615         {0x34, 0x0000a093}, {0x34, 0x0000908f},
1616         {0x34, 0x0000808c}, {0x34, 0x0000704d},
1617         {0x34, 0x0000604a}, {0x34, 0x00005047},
1618         {0x34, 0x0000400a}, {0x34, 0x00003007},
1619         {0x34, 0x00002004}, {0x34, 0x00001001},
1620         {0x34, 0x00000000},
1621 #else
1622         {0x34, 0x0000add7}, {0x34, 0x00009dd4},
1623         {0x34, 0x00008dd1}, {0x34, 0x00007dce},
1624         {0x34, 0x00006dcb}, {0x34, 0x00005dc8},
1625         {0x34, 0x00004dc5}, {0x34, 0x000034cc},
1626         {0x34, 0x0000244f}, {0x34, 0x0000144c},
1627         {0x34, 0x00000014},
1628 #endif
1629         {0x00, 0x00030159}, {0x84, 0x00068180},
1630         {0x86, 0x000000ce}, {0x87, 0x00048a00},
1631         {0x8e, 0x00065540}, {0x8f, 0x00088000},
1632         {0xef, 0x000020a0},
1633 #ifdef EXT_PA_8192EU
1634         /* External PA or external LNA */
1635         {0x3b, 0x000f07b0},
1636 #else
1637         {0x3b, 0x000f02b0},
1638 #endif
1639
1640         {0x3b, 0x000ef7b0}, {0x3b, 0x000d4fb0},
1641         {0x3b, 0x000cf060}, {0x3b, 0x000b0090},
1642         {0x3b, 0x000a0080}, {0x3b, 0x00090080},
1643         {0x3b, 0x0008f780},
1644 #ifdef EXT_PA_8192EU
1645         /* External PA or external LNA */
1646         {0x3b, 0x000787b0},
1647 #else
1648         {0x3b, 0x00078730},
1649 #endif
1650         {0x3b, 0x00060fb0}, {0x3b, 0x0005ffa0},
1651         {0x3b, 0x00040620}, {0x3b, 0x00037090},
1652         {0x3b, 0x00020080}, {0x3b, 0x0001f060},
1653         {0x3b, 0x0000ffb0}, {0xef, 0x000000a0},
1654         {0x00, 0x00010159}, {0xfe, 0x00000000},
1655         {0xfe, 0x00000000}, {0xfe, 0x00000000},
1656         {0xfe, 0x00000000}, {0x1e, 0x00000001},
1657         {0x1f, 0x00080000}, {0x00, 0x00033e70},
1658         {0xff, 0xffffffff}
1659 };
1660
1661 static struct rtl8xxxu_rfregs rtl8xxxu_rfregs[] = {
1662         {       /* RF_A */
1663                 .hssiparm1 = REG_FPGA0_XA_HSSI_PARM1,
1664                 .hssiparm2 = REG_FPGA0_XA_HSSI_PARM2,
1665                 .lssiparm = REG_FPGA0_XA_LSSI_PARM,
1666                 .hspiread = REG_HSPI_XA_READBACK,
1667                 .lssiread = REG_FPGA0_XA_LSSI_READBACK,
1668                 .rf_sw_ctrl = REG_FPGA0_XA_RF_SW_CTRL,
1669         },
1670         {       /* RF_B */
1671                 .hssiparm1 = REG_FPGA0_XB_HSSI_PARM1,
1672                 .hssiparm2 = REG_FPGA0_XB_HSSI_PARM2,
1673                 .lssiparm = REG_FPGA0_XB_LSSI_PARM,
1674                 .hspiread = REG_HSPI_XB_READBACK,
1675                 .lssiread = REG_FPGA0_XB_LSSI_READBACK,
1676                 .rf_sw_ctrl = REG_FPGA0_XB_RF_SW_CTRL,
1677         },
1678 };
1679
1680 static const u32 rtl8723au_iqk_phy_iq_bb_reg[RTL8XXXU_BB_REGS] = {
1681         REG_OFDM0_XA_RX_IQ_IMBALANCE,
1682         REG_OFDM0_XB_RX_IQ_IMBALANCE,
1683         REG_OFDM0_ENERGY_CCA_THRES,
1684         REG_OFDM0_AGCR_SSI_TABLE,
1685         REG_OFDM0_XA_TX_IQ_IMBALANCE,
1686         REG_OFDM0_XB_TX_IQ_IMBALANCE,
1687         REG_OFDM0_XC_TX_AFE,
1688         REG_OFDM0_XD_TX_AFE,
1689         REG_OFDM0_RX_IQ_EXT_ANTA
1690 };
1691
1692 static u8 rtl8xxxu_read8(struct rtl8xxxu_priv *priv, u16 addr)
1693 {
1694         struct usb_device *udev = priv->udev;
1695         int len;
1696         u8 data;
1697
1698         mutex_lock(&priv->usb_buf_mutex);
1699         len = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
1700                               REALTEK_USB_CMD_REQ, REALTEK_USB_READ,
1701                               addr, 0, &priv->usb_buf.val8, sizeof(u8),
1702                               RTW_USB_CONTROL_MSG_TIMEOUT);
1703         data = priv->usb_buf.val8;
1704         mutex_unlock(&priv->usb_buf_mutex);
1705
1706         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_REG_READ)
1707                 dev_info(&udev->dev, "%s(%04x)   = 0x%02x, len %i\n",
1708                          __func__, addr, data, len);
1709         return data;
1710 }
1711
1712 static u16 rtl8xxxu_read16(struct rtl8xxxu_priv *priv, u16 addr)
1713 {
1714         struct usb_device *udev = priv->udev;
1715         int len;
1716         u16 data;
1717
1718         mutex_lock(&priv->usb_buf_mutex);
1719         len = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
1720                               REALTEK_USB_CMD_REQ, REALTEK_USB_READ,
1721                               addr, 0, &priv->usb_buf.val16, sizeof(u16),
1722                               RTW_USB_CONTROL_MSG_TIMEOUT);
1723         data = le16_to_cpu(priv->usb_buf.val16);
1724         mutex_unlock(&priv->usb_buf_mutex);
1725
1726         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_REG_READ)
1727                 dev_info(&udev->dev, "%s(%04x)  = 0x%04x, len %i\n",
1728                          __func__, addr, data, len);
1729         return data;
1730 }
1731
1732 static u32 rtl8xxxu_read32(struct rtl8xxxu_priv *priv, u16 addr)
1733 {
1734         struct usb_device *udev = priv->udev;
1735         int len;
1736         u32 data;
1737
1738         mutex_lock(&priv->usb_buf_mutex);
1739         len = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
1740                               REALTEK_USB_CMD_REQ, REALTEK_USB_READ,
1741                               addr, 0, &priv->usb_buf.val32, sizeof(u32),
1742                               RTW_USB_CONTROL_MSG_TIMEOUT);
1743         data = le32_to_cpu(priv->usb_buf.val32);
1744         mutex_unlock(&priv->usb_buf_mutex);
1745
1746         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_REG_READ)
1747                 dev_info(&udev->dev, "%s(%04x)  = 0x%08x, len %i\n",
1748                          __func__, addr, data, len);
1749         return data;
1750 }
1751
1752 static int rtl8xxxu_write8(struct rtl8xxxu_priv *priv, u16 addr, u8 val)
1753 {
1754         struct usb_device *udev = priv->udev;
1755         int ret;
1756
1757         mutex_lock(&priv->usb_buf_mutex);
1758         priv->usb_buf.val8 = val;
1759         ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
1760                               REALTEK_USB_CMD_REQ, REALTEK_USB_WRITE,
1761                               addr, 0, &priv->usb_buf.val8, sizeof(u8),
1762                               RTW_USB_CONTROL_MSG_TIMEOUT);
1763
1764         mutex_unlock(&priv->usb_buf_mutex);
1765
1766         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_REG_WRITE)
1767                 dev_info(&udev->dev, "%s(%04x) = 0x%02x\n",
1768                          __func__, addr, val);
1769         return ret;
1770 }
1771
1772 static int rtl8xxxu_write16(struct rtl8xxxu_priv *priv, u16 addr, u16 val)
1773 {
1774         struct usb_device *udev = priv->udev;
1775         int ret;
1776
1777         mutex_lock(&priv->usb_buf_mutex);
1778         priv->usb_buf.val16 = cpu_to_le16(val);
1779         ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
1780                               REALTEK_USB_CMD_REQ, REALTEK_USB_WRITE,
1781                               addr, 0, &priv->usb_buf.val16, sizeof(u16),
1782                               RTW_USB_CONTROL_MSG_TIMEOUT);
1783         mutex_unlock(&priv->usb_buf_mutex);
1784
1785         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_REG_WRITE)
1786                 dev_info(&udev->dev, "%s(%04x) = 0x%04x\n",
1787                          __func__, addr, val);
1788         return ret;
1789 }
1790
1791 static int rtl8xxxu_write32(struct rtl8xxxu_priv *priv, u16 addr, u32 val)
1792 {
1793         struct usb_device *udev = priv->udev;
1794         int ret;
1795
1796         mutex_lock(&priv->usb_buf_mutex);
1797         priv->usb_buf.val32 = cpu_to_le32(val);
1798         ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
1799                               REALTEK_USB_CMD_REQ, REALTEK_USB_WRITE,
1800                               addr, 0, &priv->usb_buf.val32, sizeof(u32),
1801                               RTW_USB_CONTROL_MSG_TIMEOUT);
1802         mutex_unlock(&priv->usb_buf_mutex);
1803
1804         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_REG_WRITE)
1805                 dev_info(&udev->dev, "%s(%04x) = 0x%08x\n",
1806                          __func__, addr, val);
1807         return ret;
1808 }
1809
1810 static int
1811 rtl8xxxu_writeN(struct rtl8xxxu_priv *priv, u16 addr, u8 *buf, u16 len)
1812 {
1813         struct usb_device *udev = priv->udev;
1814         int blocksize = priv->fops->writeN_block_size;
1815         int ret, i, count, remainder;
1816
1817         count = len / blocksize;
1818         remainder = len % blocksize;
1819
1820         for (i = 0; i < count; i++) {
1821                 ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
1822                                       REALTEK_USB_CMD_REQ, REALTEK_USB_WRITE,
1823                                       addr, 0, buf, blocksize,
1824                                       RTW_USB_CONTROL_MSG_TIMEOUT);
1825                 if (ret != blocksize)
1826                         goto write_error;
1827
1828                 addr += blocksize;
1829                 buf += blocksize;
1830         }
1831
1832         if (remainder) {
1833                 ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
1834                                       REALTEK_USB_CMD_REQ, REALTEK_USB_WRITE,
1835                                       addr, 0, buf, remainder,
1836                                       RTW_USB_CONTROL_MSG_TIMEOUT);
1837                 if (ret != remainder)
1838                         goto write_error;
1839         }
1840
1841         return len;
1842
1843 write_error:
1844         dev_info(&udev->dev,
1845                  "%s: Failed to write block at addr: %04x size: %04x\n",
1846                  __func__, addr, blocksize);
1847         return -EAGAIN;
1848 }
1849
1850 static u32 rtl8xxxu_read_rfreg(struct rtl8xxxu_priv *priv,
1851                                enum rtl8xxxu_rfpath path, u8 reg)
1852 {
1853         u32 hssia, val32, retval;
1854
1855         hssia = rtl8xxxu_read32(priv, REG_FPGA0_XA_HSSI_PARM2);
1856         if (path != RF_A)
1857                 val32 = rtl8xxxu_read32(priv, rtl8xxxu_rfregs[path].hssiparm2);
1858         else
1859                 val32 = hssia;
1860
1861         val32 &= ~FPGA0_HSSI_PARM2_ADDR_MASK;
1862         val32 |= (reg << FPGA0_HSSI_PARM2_ADDR_SHIFT);
1863         val32 |= FPGA0_HSSI_PARM2_EDGE_READ;
1864         hssia &= ~FPGA0_HSSI_PARM2_EDGE_READ;
1865         rtl8xxxu_write32(priv, REG_FPGA0_XA_HSSI_PARM2, hssia);
1866
1867         udelay(10);
1868
1869         rtl8xxxu_write32(priv, rtl8xxxu_rfregs[path].hssiparm2, val32);
1870         udelay(100);
1871
1872         hssia |= FPGA0_HSSI_PARM2_EDGE_READ;
1873         rtl8xxxu_write32(priv, REG_FPGA0_XA_HSSI_PARM2, hssia);
1874         udelay(10);
1875
1876         val32 = rtl8xxxu_read32(priv, rtl8xxxu_rfregs[path].hssiparm1);
1877         if (val32 & FPGA0_HSSI_PARM1_PI)
1878                 retval = rtl8xxxu_read32(priv, rtl8xxxu_rfregs[path].hspiread);
1879         else
1880                 retval = rtl8xxxu_read32(priv, rtl8xxxu_rfregs[path].lssiread);
1881
1882         retval &= 0xfffff;
1883
1884         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_RFREG_READ)
1885                 dev_info(&priv->udev->dev, "%s(%02x) = 0x%06x\n",
1886                          __func__, reg, retval);
1887         return retval;
1888 }
1889
1890 /*
1891  * The RTL8723BU driver indicates that registers 0xb2 and 0xb6 can
1892  * have write issues in high temperature conditions. We may have to
1893  * retry writing them.
1894  */
1895 static int rtl8xxxu_write_rfreg(struct rtl8xxxu_priv *priv,
1896                                 enum rtl8xxxu_rfpath path, u8 reg, u32 data)
1897 {
1898         int ret, retval;
1899         u32 dataaddr, val32;
1900
1901         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_RFREG_WRITE)
1902                 dev_info(&priv->udev->dev, "%s(%02x) = 0x%06x\n",
1903                          __func__, reg, data);
1904
1905         data &= FPGA0_LSSI_PARM_DATA_MASK;
1906         dataaddr = (reg << FPGA0_LSSI_PARM_ADDR_SHIFT) | data;
1907
1908         if (priv->rtl_chip == RTL8192E) {
1909                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_POWER_SAVE);
1910                 val32 &= ~0x20000;
1911                 rtl8xxxu_write32(priv, REG_FPGA0_POWER_SAVE, val32);
1912         }
1913
1914         /* Use XB for path B */
1915         ret = rtl8xxxu_write32(priv, rtl8xxxu_rfregs[path].lssiparm, dataaddr);
1916         if (ret != sizeof(dataaddr))
1917                 retval = -EIO;
1918         else
1919                 retval = 0;
1920
1921         udelay(1);
1922
1923         if (priv->rtl_chip == RTL8192E) {
1924                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_POWER_SAVE);
1925                 val32 |= 0x20000;
1926                 rtl8xxxu_write32(priv, REG_FPGA0_POWER_SAVE, val32);
1927         }
1928
1929         return retval;
1930 }
1931
1932 static int rtl8723a_h2c_cmd(struct rtl8xxxu_priv *priv,
1933                             struct h2c_cmd *h2c, int len)
1934 {
1935         struct device *dev = &priv->udev->dev;
1936         int mbox_nr, retry, retval = 0;
1937         int mbox_reg, mbox_ext_reg;
1938         u8 val8;
1939
1940         mutex_lock(&priv->h2c_mutex);
1941
1942         mbox_nr = priv->next_mbox;
1943         mbox_reg = REG_HMBOX_0 + (mbox_nr * 4);
1944         mbox_ext_reg = priv->fops->mbox_ext_reg +
1945                 (mbox_nr * priv->fops->mbox_ext_width);
1946
1947         /*
1948          * MBOX ready?
1949          */
1950         retry = 100;
1951         do {
1952                 val8 = rtl8xxxu_read8(priv, REG_HMTFR);
1953                 if (!(val8 & BIT(mbox_nr)))
1954                         break;
1955         } while (retry--);
1956
1957         if (!retry) {
1958                 dev_info(dev, "%s: Mailbox busy\n", __func__);
1959                 retval = -EBUSY;
1960                 goto error;
1961         }
1962
1963         /*
1964          * Need to swap as it's being swapped again by rtl8xxxu_write16/32()
1965          */
1966         if (len > sizeof(u32)) {
1967                 if (priv->fops->mbox_ext_width == 4) {
1968                         rtl8xxxu_write32(priv, mbox_ext_reg,
1969                                          le32_to_cpu(h2c->raw_wide.ext));
1970                         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_H2C)
1971                                 dev_info(dev, "H2C_EXT %08x\n",
1972                                          le32_to_cpu(h2c->raw_wide.ext));
1973                 } else {
1974                         rtl8xxxu_write16(priv, mbox_ext_reg,
1975                                          le16_to_cpu(h2c->raw.ext));
1976                         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_H2C)
1977                                 dev_info(dev, "H2C_EXT %04x\n",
1978                                          le16_to_cpu(h2c->raw.ext));
1979                 }
1980         }
1981         rtl8xxxu_write32(priv, mbox_reg, le32_to_cpu(h2c->raw.data));
1982         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_H2C)
1983                 dev_info(dev, "H2C %08x\n", le32_to_cpu(h2c->raw.data));
1984
1985         priv->next_mbox = (mbox_nr + 1) % H2C_MAX_MBOX;
1986
1987 error:
1988         mutex_unlock(&priv->h2c_mutex);
1989         return retval;
1990 }
1991
1992 static void rtl8723bu_write_btreg(struct rtl8xxxu_priv *priv, u8 reg, u8 data)
1993 {
1994         struct h2c_cmd h2c;
1995         int reqnum = 0;
1996
1997         memset(&h2c, 0, sizeof(struct h2c_cmd));
1998         h2c.bt_mp_oper.cmd = H2C_8723B_BT_MP_OPER;
1999         h2c.bt_mp_oper.operreq = 0 | (reqnum << 4);
2000         h2c.bt_mp_oper.opcode = BT_MP_OP_WRITE_REG_VALUE;
2001         h2c.bt_mp_oper.data = data;
2002         rtl8723a_h2c_cmd(priv, &h2c, sizeof(h2c.bt_mp_oper));
2003
2004         reqnum++;
2005         memset(&h2c, 0, sizeof(struct h2c_cmd));
2006         h2c.bt_mp_oper.cmd = H2C_8723B_BT_MP_OPER;
2007         h2c.bt_mp_oper.operreq = 0 | (reqnum << 4);
2008         h2c.bt_mp_oper.opcode = BT_MP_OP_WRITE_REG_VALUE;
2009         h2c.bt_mp_oper.addr = reg;
2010         rtl8723a_h2c_cmd(priv, &h2c, sizeof(h2c.bt_mp_oper));
2011 }
2012
2013 static void rtl8723a_enable_rf(struct rtl8xxxu_priv *priv)
2014 {
2015         u8 val8;
2016         u32 val32;
2017
2018         val8 = rtl8xxxu_read8(priv, REG_SPS0_CTRL);
2019         val8 |= BIT(0) | BIT(3);
2020         rtl8xxxu_write8(priv, REG_SPS0_CTRL, val8);
2021
2022         val32 = rtl8xxxu_read32(priv, REG_FPGA0_XAB_RF_PARM);
2023         val32 &= ~(BIT(4) | BIT(5));
2024         val32 |= BIT(3);
2025         if (priv->rf_paths == 2) {
2026                 val32 &= ~(BIT(20) | BIT(21));
2027                 val32 |= BIT(19);
2028         }
2029         rtl8xxxu_write32(priv, REG_FPGA0_XAB_RF_PARM, val32);
2030
2031         val32 = rtl8xxxu_read32(priv, REG_OFDM0_TRX_PATH_ENABLE);
2032         val32 &= ~OFDM_RF_PATH_TX_MASK;
2033         if (priv->tx_paths == 2)
2034                 val32 |= OFDM_RF_PATH_TX_A | OFDM_RF_PATH_TX_B;
2035         else if (priv->rtl_chip == RTL8192C || priv->rtl_chip == RTL8191C)
2036                 val32 |= OFDM_RF_PATH_TX_B;
2037         else
2038                 val32 |= OFDM_RF_PATH_TX_A;
2039         rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, val32);
2040
2041         val32 = rtl8xxxu_read32(priv, REG_FPGA0_RF_MODE);
2042         val32 &= ~FPGA_RF_MODE_JAPAN;
2043         rtl8xxxu_write32(priv, REG_FPGA0_RF_MODE, val32);
2044
2045         if (priv->rf_paths == 2)
2046                 rtl8xxxu_write32(priv, REG_RX_WAIT_CCA, 0x63db25a0);
2047         else
2048                 rtl8xxxu_write32(priv, REG_RX_WAIT_CCA, 0x631b25a0);
2049
2050         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_AC, 0x32d95);
2051         if (priv->rf_paths == 2)
2052                 rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_AC, 0x32d95);
2053
2054         rtl8xxxu_write8(priv, REG_TXPAUSE, 0x00);
2055 }
2056
2057 static void rtl8723a_disable_rf(struct rtl8xxxu_priv *priv)
2058 {
2059         u8 sps0;
2060         u32 val32;
2061
2062         rtl8xxxu_write8(priv, REG_TXPAUSE, 0xff);
2063
2064         sps0 = rtl8xxxu_read8(priv, REG_SPS0_CTRL);
2065
2066         /* RF RX code for preamble power saving */
2067         val32 = rtl8xxxu_read32(priv, REG_FPGA0_XAB_RF_PARM);
2068         val32 &= ~(BIT(3) | BIT(4) | BIT(5));
2069         if (priv->rf_paths == 2)
2070                 val32 &= ~(BIT(19) | BIT(20) | BIT(21));
2071         rtl8xxxu_write32(priv, REG_FPGA0_XAB_RF_PARM, val32);
2072
2073         /* Disable TX for four paths */
2074         val32 = rtl8xxxu_read32(priv, REG_OFDM0_TRX_PATH_ENABLE);
2075         val32 &= ~OFDM_RF_PATH_TX_MASK;
2076         rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, val32);
2077
2078         /* Enable power saving */
2079         val32 = rtl8xxxu_read32(priv, REG_FPGA0_RF_MODE);
2080         val32 |= FPGA_RF_MODE_JAPAN;
2081         rtl8xxxu_write32(priv, REG_FPGA0_RF_MODE, val32);
2082
2083         /* AFE control register to power down bits [30:22] */
2084         if (priv->rf_paths == 2)
2085                 rtl8xxxu_write32(priv, REG_RX_WAIT_CCA, 0x00db25a0);
2086         else
2087                 rtl8xxxu_write32(priv, REG_RX_WAIT_CCA, 0x001b25a0);
2088
2089         /* Power down RF module */
2090         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_AC, 0);
2091         if (priv->rf_paths == 2)
2092                 rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_AC, 0);
2093
2094         sps0 &= ~(BIT(0) | BIT(3));
2095         rtl8xxxu_write8(priv, REG_SPS0_CTRL, sps0);
2096 }
2097
2098
2099 static void rtl8723a_stop_tx_beacon(struct rtl8xxxu_priv *priv)
2100 {
2101         u8 val8;
2102
2103         val8 = rtl8xxxu_read8(priv, REG_FWHW_TXQ_CTRL + 2);
2104         val8 &= ~BIT(6);
2105         rtl8xxxu_write8(priv, REG_FWHW_TXQ_CTRL + 2, val8);
2106
2107         rtl8xxxu_write8(priv, REG_TBTT_PROHIBIT + 1, 0x64);
2108         val8 = rtl8xxxu_read8(priv, REG_TBTT_PROHIBIT + 2);
2109         val8 &= ~BIT(0);
2110         rtl8xxxu_write8(priv, REG_TBTT_PROHIBIT + 2, val8);
2111 }
2112
2113
2114 /*
2115  * The rtl8723a has 3 channel groups for it's efuse settings. It only
2116  * supports the 2.4GHz band, so channels 1 - 14:
2117  *  group 0: channels 1 - 3
2118  *  group 1: channels 4 - 9
2119  *  group 2: channels 10 - 14
2120  *
2121  * Note: We index from 0 in the code
2122  */
2123 static int rtl8723a_channel_to_group(int channel)
2124 {
2125         int group;
2126
2127         if (channel < 4)
2128                 group = 0;
2129         else if (channel < 10)
2130                 group = 1;
2131         else
2132                 group = 2;
2133
2134         return group;
2135 }
2136
2137 /*
2138  * Valid for rtl8723bu and rtl8192eu
2139  */
2140 static int rtl8723b_channel_to_group(int channel)
2141 {
2142         int group;
2143
2144         if (channel < 3)
2145                 group = 0;
2146         else if (channel < 6)
2147                 group = 1;
2148         else if (channel < 9)
2149                 group = 2;
2150         else if (channel < 12)
2151                 group = 3;
2152         else
2153                 group = 4;
2154
2155         return group;
2156 }
2157
2158 static void rtl8723au_config_channel(struct ieee80211_hw *hw)
2159 {
2160         struct rtl8xxxu_priv *priv = hw->priv;
2161         u32 val32, rsr;
2162         u8 val8, opmode;
2163         bool ht = true;
2164         int sec_ch_above, channel;
2165         int i;
2166
2167         opmode = rtl8xxxu_read8(priv, REG_BW_OPMODE);
2168         rsr = rtl8xxxu_read32(priv, REG_RESPONSE_RATE_SET);
2169         channel = hw->conf.chandef.chan->hw_value;
2170
2171         switch (hw->conf.chandef.width) {
2172         case NL80211_CHAN_WIDTH_20_NOHT:
2173                 ht = false;
2174         case NL80211_CHAN_WIDTH_20:
2175                 opmode |= BW_OPMODE_20MHZ;
2176                 rtl8xxxu_write8(priv, REG_BW_OPMODE, opmode);
2177
2178                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_RF_MODE);
2179                 val32 &= ~FPGA_RF_MODE;
2180                 rtl8xxxu_write32(priv, REG_FPGA0_RF_MODE, val32);
2181
2182                 val32 = rtl8xxxu_read32(priv, REG_FPGA1_RF_MODE);
2183                 val32 &= ~FPGA_RF_MODE;
2184                 rtl8xxxu_write32(priv, REG_FPGA1_RF_MODE, val32);
2185
2186                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_ANALOG2);
2187                 val32 |= FPGA0_ANALOG2_20MHZ;
2188                 rtl8xxxu_write32(priv, REG_FPGA0_ANALOG2, val32);
2189                 break;
2190         case NL80211_CHAN_WIDTH_40:
2191                 if (hw->conf.chandef.center_freq1 >
2192                     hw->conf.chandef.chan->center_freq) {
2193                         sec_ch_above = 1;
2194                         channel += 2;
2195                 } else {
2196                         sec_ch_above = 0;
2197                         channel -= 2;
2198                 }
2199
2200                 opmode &= ~BW_OPMODE_20MHZ;
2201                 rtl8xxxu_write8(priv, REG_BW_OPMODE, opmode);
2202                 rsr &= ~RSR_RSC_BANDWIDTH_40M;
2203                 if (sec_ch_above)
2204                         rsr |= RSR_RSC_UPPER_SUB_CHANNEL;
2205                 else
2206                         rsr |= RSR_RSC_LOWER_SUB_CHANNEL;
2207                 rtl8xxxu_write32(priv, REG_RESPONSE_RATE_SET, rsr);
2208
2209                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_RF_MODE);
2210                 val32 |= FPGA_RF_MODE;
2211                 rtl8xxxu_write32(priv, REG_FPGA0_RF_MODE, val32);
2212
2213                 val32 = rtl8xxxu_read32(priv, REG_FPGA1_RF_MODE);
2214                 val32 |= FPGA_RF_MODE;
2215                 rtl8xxxu_write32(priv, REG_FPGA1_RF_MODE, val32);
2216
2217                 /*
2218                  * Set Control channel to upper or lower. These settings
2219                  * are required only for 40MHz
2220                  */
2221                 val32 = rtl8xxxu_read32(priv, REG_CCK0_SYSTEM);
2222                 val32 &= ~CCK0_SIDEBAND;
2223                 if (!sec_ch_above)
2224                         val32 |= CCK0_SIDEBAND;
2225                 rtl8xxxu_write32(priv, REG_CCK0_SYSTEM, val32);
2226
2227                 val32 = rtl8xxxu_read32(priv, REG_OFDM1_LSTF);
2228                 val32 &= ~OFDM_LSTF_PRIME_CH_MASK; /* 0xc00 */
2229                 if (sec_ch_above)
2230                         val32 |= OFDM_LSTF_PRIME_CH_LOW;
2231                 else
2232                         val32 |= OFDM_LSTF_PRIME_CH_HIGH;
2233                 rtl8xxxu_write32(priv, REG_OFDM1_LSTF, val32);
2234
2235                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_ANALOG2);
2236                 val32 &= ~FPGA0_ANALOG2_20MHZ;
2237                 rtl8xxxu_write32(priv, REG_FPGA0_ANALOG2, val32);
2238
2239                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_POWER_SAVE);
2240                 val32 &= ~(FPGA0_PS_LOWER_CHANNEL | FPGA0_PS_UPPER_CHANNEL);
2241                 if (sec_ch_above)
2242                         val32 |= FPGA0_PS_UPPER_CHANNEL;
2243                 else
2244                         val32 |= FPGA0_PS_LOWER_CHANNEL;
2245                 rtl8xxxu_write32(priv, REG_FPGA0_POWER_SAVE, val32);
2246                 break;
2247
2248         default:
2249                 break;
2250         }
2251
2252         for (i = RF_A; i < priv->rf_paths; i++) {
2253                 val32 = rtl8xxxu_read_rfreg(priv, i, RF6052_REG_MODE_AG);
2254                 val32 &= ~MODE_AG_CHANNEL_MASK;
2255                 val32 |= channel;
2256                 rtl8xxxu_write_rfreg(priv, i, RF6052_REG_MODE_AG, val32);
2257         }
2258
2259         if (ht)
2260                 val8 = 0x0e;
2261         else
2262                 val8 = 0x0a;
2263
2264         rtl8xxxu_write8(priv, REG_SIFS_CCK + 1, val8);
2265         rtl8xxxu_write8(priv, REG_SIFS_OFDM + 1, val8);
2266
2267         rtl8xxxu_write16(priv, REG_R2T_SIFS, 0x0808);
2268         rtl8xxxu_write16(priv, REG_T2T_SIFS, 0x0a0a);
2269
2270         for (i = RF_A; i < priv->rf_paths; i++) {
2271                 val32 = rtl8xxxu_read_rfreg(priv, i, RF6052_REG_MODE_AG);
2272                 if (hw->conf.chandef.width == NL80211_CHAN_WIDTH_40)
2273                         val32 &= ~MODE_AG_CHANNEL_20MHZ;
2274                 else
2275                         val32 |= MODE_AG_CHANNEL_20MHZ;
2276                 rtl8xxxu_write_rfreg(priv, i, RF6052_REG_MODE_AG, val32);
2277         }
2278 }
2279
2280 static void rtl8723bu_config_channel(struct ieee80211_hw *hw)
2281 {
2282         struct rtl8xxxu_priv *priv = hw->priv;
2283         u32 val32, rsr;
2284         u8 val8, subchannel;
2285         u16 rf_mode_bw;
2286         bool ht = true;
2287         int sec_ch_above, channel;
2288         int i;
2289
2290         rf_mode_bw = rtl8xxxu_read16(priv, REG_WMAC_TRXPTCL_CTL);
2291         rf_mode_bw &= ~WMAC_TRXPTCL_CTL_BW_MASK;
2292         rsr = rtl8xxxu_read32(priv, REG_RESPONSE_RATE_SET);
2293         channel = hw->conf.chandef.chan->hw_value;
2294
2295 /* Hack */
2296         subchannel = 0;
2297
2298         switch (hw->conf.chandef.width) {
2299         case NL80211_CHAN_WIDTH_20_NOHT:
2300                 ht = false;
2301         case NL80211_CHAN_WIDTH_20:
2302                 rf_mode_bw |= WMAC_TRXPTCL_CTL_BW_20;
2303                 subchannel = 0;
2304
2305                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_RF_MODE);
2306                 val32 &= ~FPGA_RF_MODE;
2307                 rtl8xxxu_write32(priv, REG_FPGA0_RF_MODE, val32);
2308
2309                 val32 = rtl8xxxu_read32(priv, REG_FPGA1_RF_MODE);
2310                 val32 &= ~FPGA_RF_MODE;
2311                 rtl8xxxu_write32(priv, REG_FPGA1_RF_MODE, val32);
2312
2313                 val32 = rtl8xxxu_read32(priv, REG_OFDM0_TX_PSDO_NOISE_WEIGHT);
2314                 val32 &= ~(BIT(30) | BIT(31));
2315                 rtl8xxxu_write32(priv, REG_OFDM0_TX_PSDO_NOISE_WEIGHT, val32);
2316
2317                 break;
2318         case NL80211_CHAN_WIDTH_40:
2319                 rf_mode_bw |= WMAC_TRXPTCL_CTL_BW_40;
2320
2321                 if (hw->conf.chandef.center_freq1 >
2322                     hw->conf.chandef.chan->center_freq) {
2323                         sec_ch_above = 1;
2324                         channel += 2;
2325                 } else {
2326                         sec_ch_above = 0;
2327                         channel -= 2;
2328                 }
2329
2330                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_RF_MODE);
2331                 val32 |= FPGA_RF_MODE;
2332                 rtl8xxxu_write32(priv, REG_FPGA0_RF_MODE, val32);
2333
2334                 val32 = rtl8xxxu_read32(priv, REG_FPGA1_RF_MODE);
2335                 val32 |= FPGA_RF_MODE;
2336                 rtl8xxxu_write32(priv, REG_FPGA1_RF_MODE, val32);
2337
2338                 /*
2339                  * Set Control channel to upper or lower. These settings
2340                  * are required only for 40MHz
2341                  */
2342                 val32 = rtl8xxxu_read32(priv, REG_CCK0_SYSTEM);
2343                 val32 &= ~CCK0_SIDEBAND;
2344                 if (!sec_ch_above)
2345                         val32 |= CCK0_SIDEBAND;
2346                 rtl8xxxu_write32(priv, REG_CCK0_SYSTEM, val32);
2347
2348                 val32 = rtl8xxxu_read32(priv, REG_OFDM1_LSTF);
2349                 val32 &= ~OFDM_LSTF_PRIME_CH_MASK; /* 0xc00 */
2350                 if (sec_ch_above)
2351                         val32 |= OFDM_LSTF_PRIME_CH_LOW;
2352                 else
2353                         val32 |= OFDM_LSTF_PRIME_CH_HIGH;
2354                 rtl8xxxu_write32(priv, REG_OFDM1_LSTF, val32);
2355
2356                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_POWER_SAVE);
2357                 val32 &= ~(FPGA0_PS_LOWER_CHANNEL | FPGA0_PS_UPPER_CHANNEL);
2358                 if (sec_ch_above)
2359                         val32 |= FPGA0_PS_UPPER_CHANNEL;
2360                 else
2361                         val32 |= FPGA0_PS_LOWER_CHANNEL;
2362                 rtl8xxxu_write32(priv, REG_FPGA0_POWER_SAVE, val32);
2363                 break;
2364         case NL80211_CHAN_WIDTH_80:
2365                 rf_mode_bw |= WMAC_TRXPTCL_CTL_BW_80;
2366                 break;
2367         default:
2368                 break;
2369         }
2370
2371         for (i = RF_A; i < priv->rf_paths; i++) {
2372                 val32 = rtl8xxxu_read_rfreg(priv, i, RF6052_REG_MODE_AG);
2373                 val32 &= ~MODE_AG_CHANNEL_MASK;
2374                 val32 |= channel;
2375                 rtl8xxxu_write_rfreg(priv, i, RF6052_REG_MODE_AG, val32);
2376         }
2377
2378         rtl8xxxu_write16(priv, REG_WMAC_TRXPTCL_CTL, rf_mode_bw);
2379         rtl8xxxu_write8(priv, REG_DATA_SUBCHANNEL, subchannel);
2380
2381         if (ht)
2382                 val8 = 0x0e;
2383         else
2384                 val8 = 0x0a;
2385
2386         rtl8xxxu_write8(priv, REG_SIFS_CCK + 1, val8);
2387         rtl8xxxu_write8(priv, REG_SIFS_OFDM + 1, val8);
2388
2389         rtl8xxxu_write16(priv, REG_R2T_SIFS, 0x0808);
2390         rtl8xxxu_write16(priv, REG_T2T_SIFS, 0x0a0a);
2391
2392         for (i = RF_A; i < priv->rf_paths; i++) {
2393                 val32 = rtl8xxxu_read_rfreg(priv, i, RF6052_REG_MODE_AG);
2394                 val32 &= ~MODE_AG_BW_MASK;
2395                 switch(hw->conf.chandef.width) {
2396                 case NL80211_CHAN_WIDTH_80:
2397                         val32 |= MODE_AG_BW_80MHZ_8723B;
2398                         break;
2399                 case NL80211_CHAN_WIDTH_40:
2400                         val32 |= MODE_AG_BW_40MHZ_8723B;
2401                         break;
2402                 default:
2403                         val32 |= MODE_AG_BW_20MHZ_8723B;
2404                         break;
2405                 }
2406                 rtl8xxxu_write_rfreg(priv, i, RF6052_REG_MODE_AG, val32);
2407         }
2408 }
2409
2410 static void
2411 rtl8723a_set_tx_power(struct rtl8xxxu_priv *priv, int channel, bool ht40)
2412 {
2413         u8 cck[RTL8723A_MAX_RF_PATHS], ofdm[RTL8723A_MAX_RF_PATHS];
2414         u8 ofdmbase[RTL8723A_MAX_RF_PATHS], mcsbase[RTL8723A_MAX_RF_PATHS];
2415         u32 val32, ofdm_a, ofdm_b, mcs_a, mcs_b;
2416         u8 val8;
2417         int group, i;
2418
2419         group = rtl8723a_channel_to_group(channel);
2420
2421         cck[0] = priv->cck_tx_power_index_A[group];
2422         cck[1] = priv->cck_tx_power_index_B[group];
2423
2424         ofdm[0] = priv->ht40_1s_tx_power_index_A[group];
2425         ofdm[1] = priv->ht40_1s_tx_power_index_B[group];
2426
2427         ofdmbase[0] = ofdm[0] + priv->ofdm_tx_power_index_diff[group].a;
2428         ofdmbase[1] = ofdm[1] + priv->ofdm_tx_power_index_diff[group].b;
2429
2430         mcsbase[0] = ofdm[0];
2431         mcsbase[1] = ofdm[1];
2432         if (!ht40) {
2433                 mcsbase[0] += priv->ht20_tx_power_index_diff[group].a;
2434                 mcsbase[1] += priv->ht20_tx_power_index_diff[group].b;
2435         }
2436
2437         if (priv->tx_paths > 1) {
2438                 if (ofdm[0] > priv->ht40_2s_tx_power_index_diff[group].a)
2439                         ofdm[0] -=  priv->ht40_2s_tx_power_index_diff[group].a;
2440                 if (ofdm[1] > priv->ht40_2s_tx_power_index_diff[group].b)
2441                         ofdm[1] -=  priv->ht40_2s_tx_power_index_diff[group].b;
2442         }
2443
2444         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_CHANNEL)
2445                 dev_info(&priv->udev->dev,
2446                          "%s: Setting TX power CCK A: %02x, "
2447                          "CCK B: %02x, OFDM A: %02x, OFDM B: %02x\n",
2448                          __func__, cck[0], cck[1], ofdm[0], ofdm[1]);
2449
2450         for (i = 0; i < RTL8723A_MAX_RF_PATHS; i++) {
2451                 if (cck[i] > RF6052_MAX_TX_PWR)
2452                         cck[i] = RF6052_MAX_TX_PWR;
2453                 if (ofdm[i] > RF6052_MAX_TX_PWR)
2454                         ofdm[i] = RF6052_MAX_TX_PWR;
2455         }
2456
2457         val32 = rtl8xxxu_read32(priv, REG_TX_AGC_A_CCK1_MCS32);
2458         val32 &= 0xffff00ff;
2459         val32 |= (cck[0] << 8);
2460         rtl8xxxu_write32(priv, REG_TX_AGC_A_CCK1_MCS32, val32);
2461
2462         val32 = rtl8xxxu_read32(priv, REG_TX_AGC_B_CCK11_A_CCK2_11);
2463         val32 &= 0xff;
2464         val32 |= ((cck[0] << 8) | (cck[0] << 16) | (cck[0] << 24));
2465         rtl8xxxu_write32(priv, REG_TX_AGC_B_CCK11_A_CCK2_11, val32);
2466
2467         val32 = rtl8xxxu_read32(priv, REG_TX_AGC_B_CCK11_A_CCK2_11);
2468         val32 &= 0xffffff00;
2469         val32 |= cck[1];
2470         rtl8xxxu_write32(priv, REG_TX_AGC_B_CCK11_A_CCK2_11, val32);
2471
2472         val32 = rtl8xxxu_read32(priv, REG_TX_AGC_B_CCK1_55_MCS32);
2473         val32 &= 0xff;
2474         val32 |= ((cck[1] << 8) | (cck[1] << 16) | (cck[1] << 24));
2475         rtl8xxxu_write32(priv, REG_TX_AGC_B_CCK1_55_MCS32, val32);
2476
2477         ofdm_a = ofdmbase[0] | ofdmbase[0] << 8 |
2478                 ofdmbase[0] << 16 | ofdmbase[0] << 24;
2479         ofdm_b = ofdmbase[1] | ofdmbase[1] << 8 |
2480                 ofdmbase[1] << 16 | ofdmbase[1] << 24;
2481         rtl8xxxu_write32(priv, REG_TX_AGC_A_RATE18_06, ofdm_a);
2482         rtl8xxxu_write32(priv, REG_TX_AGC_B_RATE18_06, ofdm_b);
2483
2484         rtl8xxxu_write32(priv, REG_TX_AGC_A_RATE54_24, ofdm_a);
2485         rtl8xxxu_write32(priv, REG_TX_AGC_B_RATE54_24, ofdm_b);
2486
2487         mcs_a = mcsbase[0] | mcsbase[0] << 8 |
2488                 mcsbase[0] << 16 | mcsbase[0] << 24;
2489         mcs_b = mcsbase[1] | mcsbase[1] << 8 |
2490                 mcsbase[1] << 16 | mcsbase[1] << 24;
2491
2492         rtl8xxxu_write32(priv, REG_TX_AGC_A_MCS03_MCS00, mcs_a);
2493         rtl8xxxu_write32(priv, REG_TX_AGC_B_MCS03_MCS00, mcs_b);
2494
2495         rtl8xxxu_write32(priv, REG_TX_AGC_A_MCS07_MCS04, mcs_a);
2496         rtl8xxxu_write32(priv, REG_TX_AGC_B_MCS07_MCS04, mcs_b);
2497
2498         rtl8xxxu_write32(priv, REG_TX_AGC_A_MCS11_MCS08, mcs_a);
2499         rtl8xxxu_write32(priv, REG_TX_AGC_B_MCS11_MCS08, mcs_b);
2500
2501         rtl8xxxu_write32(priv, REG_TX_AGC_A_MCS15_MCS12, mcs_a);
2502         for (i = 0; i < 3; i++) {
2503                 if (i != 2)
2504                         val8 = (mcsbase[0] > 8) ? (mcsbase[0] - 8) : 0;
2505                 else
2506                         val8 = (mcsbase[0] > 6) ? (mcsbase[0] - 6) : 0;
2507                 rtl8xxxu_write8(priv, REG_OFDM0_XC_TX_IQ_IMBALANCE + i, val8);
2508         }
2509         rtl8xxxu_write32(priv, REG_TX_AGC_B_MCS15_MCS12, mcs_b);
2510         for (i = 0; i < 3; i++) {
2511                 if (i != 2)
2512                         val8 = (mcsbase[1] > 8) ? (mcsbase[1] - 8) : 0;
2513                 else
2514                         val8 = (mcsbase[1] > 6) ? (mcsbase[1] - 6) : 0;
2515                 rtl8xxxu_write8(priv, REG_OFDM0_XD_TX_IQ_IMBALANCE + i, val8);
2516         }
2517 }
2518
2519 static void
2520 rtl8723b_set_tx_power(struct rtl8xxxu_priv *priv, int channel, bool ht40)
2521 {
2522         u32 val32, ofdm, mcs;
2523         u8 cck, ofdmbase, mcsbase;
2524         int group, tx_idx;
2525
2526         tx_idx = 0;
2527         group = rtl8723b_channel_to_group(channel);
2528
2529         cck = priv->cck_tx_power_index_B[group];
2530         val32 = rtl8xxxu_read32(priv, REG_TX_AGC_A_CCK1_MCS32);
2531         val32 &= 0xffff00ff;
2532         val32 |= (cck << 8);
2533         rtl8xxxu_write32(priv, REG_TX_AGC_A_CCK1_MCS32, val32);
2534
2535         val32 = rtl8xxxu_read32(priv, REG_TX_AGC_B_CCK11_A_CCK2_11);
2536         val32 &= 0xff;
2537         val32 |= ((cck << 8) | (cck << 16) | (cck << 24));
2538         rtl8xxxu_write32(priv, REG_TX_AGC_B_CCK11_A_CCK2_11, val32);
2539
2540         ofdmbase = priv->ht40_1s_tx_power_index_B[group];
2541         ofdmbase += priv->ofdm_tx_power_diff[tx_idx].b;
2542         ofdm = ofdmbase | ofdmbase << 8 | ofdmbase << 16 | ofdmbase << 24;
2543
2544         rtl8xxxu_write32(priv, REG_TX_AGC_A_RATE18_06, ofdm);
2545         rtl8xxxu_write32(priv, REG_TX_AGC_A_RATE54_24, ofdm);
2546
2547         mcsbase = priv->ht40_1s_tx_power_index_B[group];
2548         if (ht40)
2549                 mcsbase += priv->ht40_tx_power_diff[tx_idx++].b;
2550         else
2551                 mcsbase += priv->ht20_tx_power_diff[tx_idx++].b;
2552         mcs = mcsbase | mcsbase << 8 | mcsbase << 16 | mcsbase << 24;
2553
2554         rtl8xxxu_write32(priv, REG_TX_AGC_A_MCS03_MCS00, mcs);
2555         rtl8xxxu_write32(priv, REG_TX_AGC_A_MCS07_MCS04, mcs);
2556 }
2557
2558 static void
2559 rtl8192e_set_tx_power(struct rtl8xxxu_priv *priv, int channel, bool ht40)
2560 {
2561         u32 val32, ofdm, mcs;
2562         u8 cck, ofdmbase, mcsbase;
2563         int group, tx_idx;
2564
2565         tx_idx = 0;
2566         group = rtl8723b_channel_to_group(channel);
2567
2568         cck = priv->cck_tx_power_index_A[group];
2569
2570         val32 = rtl8xxxu_read32(priv, REG_TX_AGC_A_CCK1_MCS32);
2571         val32 &= 0xffff00ff;
2572         val32 |= (cck << 8);
2573         rtl8xxxu_write32(priv, REG_TX_AGC_A_CCK1_MCS32, val32);
2574
2575         val32 = rtl8xxxu_read32(priv, REG_TX_AGC_B_CCK11_A_CCK2_11);
2576         val32 &= 0xff;
2577         val32 |= ((cck << 8) | (cck << 16) | (cck << 24));
2578         rtl8xxxu_write32(priv, REG_TX_AGC_B_CCK11_A_CCK2_11, val32);
2579
2580         ofdmbase = priv->ht40_1s_tx_power_index_A[group];
2581         ofdmbase += priv->ofdm_tx_power_diff[tx_idx].a;
2582         ofdm = ofdmbase | ofdmbase << 8 | ofdmbase << 16 | ofdmbase << 24;
2583
2584         rtl8xxxu_write32(priv, REG_TX_AGC_A_RATE18_06, ofdm);
2585         rtl8xxxu_write32(priv, REG_TX_AGC_A_RATE54_24, ofdm);
2586
2587         mcsbase = priv->ht40_1s_tx_power_index_A[group];
2588         if (ht40)
2589                 mcsbase += priv->ht40_tx_power_diff[tx_idx++].a;
2590         else
2591                 mcsbase += priv->ht20_tx_power_diff[tx_idx++].a;
2592         mcs = mcsbase | mcsbase << 8 | mcsbase << 16 | mcsbase << 24;
2593
2594         rtl8xxxu_write32(priv, REG_TX_AGC_A_MCS03_MCS00, mcs);
2595         rtl8xxxu_write32(priv, REG_TX_AGC_A_MCS07_MCS04, mcs);
2596         rtl8xxxu_write32(priv, REG_TX_AGC_A_MCS11_MCS08, mcs);
2597         rtl8xxxu_write32(priv, REG_TX_AGC_A_MCS15_MCS12, mcs);
2598
2599         if (priv->tx_paths > 1) {
2600                 cck = priv->cck_tx_power_index_B[group];
2601
2602                 val32 = rtl8xxxu_read32(priv, REG_TX_AGC_B_CCK1_55_MCS32);
2603                 val32 &= 0xff;
2604                 val32 |= ((cck << 8) | (cck << 16) | (cck << 24));
2605                 rtl8xxxu_write32(priv, REG_TX_AGC_B_CCK1_55_MCS32, val32);
2606
2607                 val32 = rtl8xxxu_read32(priv, REG_TX_AGC_B_CCK11_A_CCK2_11);
2608                 val32 &= 0xffffff00;
2609                 val32 |= cck;
2610                 rtl8xxxu_write32(priv, REG_TX_AGC_B_CCK11_A_CCK2_11, val32);
2611
2612                 ofdmbase = priv->ht40_1s_tx_power_index_B[group];
2613                 ofdmbase += priv->ofdm_tx_power_diff[tx_idx].b;
2614                 ofdm = ofdmbase | ofdmbase << 8 |
2615                         ofdmbase << 16 | ofdmbase << 24;
2616
2617                 rtl8xxxu_write32(priv, REG_TX_AGC_B_RATE18_06, ofdm);
2618                 rtl8xxxu_write32(priv, REG_TX_AGC_B_RATE54_24, ofdm);
2619
2620                 mcsbase = priv->ht40_1s_tx_power_index_B[group];
2621                 if (ht40)
2622                         mcsbase += priv->ht40_tx_power_diff[tx_idx++].b;
2623                 else
2624                         mcsbase += priv->ht20_tx_power_diff[tx_idx++].b;
2625                 mcs = mcsbase | mcsbase << 8 | mcsbase << 16 | mcsbase << 24;
2626
2627                 rtl8xxxu_write32(priv, REG_TX_AGC_B_MCS03_MCS00, mcs);
2628                 rtl8xxxu_write32(priv, REG_TX_AGC_B_MCS07_MCS04, mcs);
2629                 rtl8xxxu_write32(priv, REG_TX_AGC_B_MCS11_MCS08, mcs);
2630                 rtl8xxxu_write32(priv, REG_TX_AGC_B_MCS15_MCS12, mcs);
2631         }
2632 }
2633
2634 static void rtl8xxxu_set_linktype(struct rtl8xxxu_priv *priv,
2635                                   enum nl80211_iftype linktype)
2636 {
2637         u8 val8;
2638
2639         val8 = rtl8xxxu_read8(priv, REG_MSR);
2640         val8 &= ~MSR_LINKTYPE_MASK;
2641
2642         switch (linktype) {
2643         case NL80211_IFTYPE_UNSPECIFIED:
2644                 val8 |= MSR_LINKTYPE_NONE;
2645                 break;
2646         case NL80211_IFTYPE_ADHOC:
2647                 val8 |= MSR_LINKTYPE_ADHOC;
2648                 break;
2649         case NL80211_IFTYPE_STATION:
2650                 val8 |= MSR_LINKTYPE_STATION;
2651                 break;
2652         case NL80211_IFTYPE_AP:
2653                 val8 |= MSR_LINKTYPE_AP;
2654                 break;
2655         default:
2656                 goto out;
2657         }
2658
2659         rtl8xxxu_write8(priv, REG_MSR, val8);
2660 out:
2661         return;
2662 }
2663
2664 static void
2665 rtl8xxxu_set_retry(struct rtl8xxxu_priv *priv, u16 short_retry, u16 long_retry)
2666 {
2667         u16 val16;
2668
2669         val16 = ((short_retry << RETRY_LIMIT_SHORT_SHIFT) &
2670                  RETRY_LIMIT_SHORT_MASK) |
2671                 ((long_retry << RETRY_LIMIT_LONG_SHIFT) &
2672                  RETRY_LIMIT_LONG_MASK);
2673
2674         rtl8xxxu_write16(priv, REG_RETRY_LIMIT, val16);
2675 }
2676
2677 static void
2678 rtl8xxxu_set_spec_sifs(struct rtl8xxxu_priv *priv, u16 cck, u16 ofdm)
2679 {
2680         u16 val16;
2681
2682         val16 = ((cck << SPEC_SIFS_CCK_SHIFT) & SPEC_SIFS_CCK_MASK) |
2683                 ((ofdm << SPEC_SIFS_OFDM_SHIFT) & SPEC_SIFS_OFDM_MASK);
2684
2685         rtl8xxxu_write16(priv, REG_SPEC_SIFS, val16);
2686 }
2687
2688 static void rtl8xxxu_print_chipinfo(struct rtl8xxxu_priv *priv)
2689 {
2690         struct device *dev = &priv->udev->dev;
2691         char *cut;
2692
2693         switch (priv->chip_cut) {
2694         case 0:
2695                 cut = "A";
2696                 break;
2697         case 1:
2698                 cut = "B";
2699                 break;
2700         case 2:
2701                 cut = "C";
2702                 break;
2703         case 3:
2704                 cut = "D";
2705                 break;
2706         case 4:
2707                 cut = "E";
2708                 break;
2709         default:
2710                 cut = "unknown";
2711         }
2712
2713         dev_info(dev,
2714                  "RTL%s rev %s (%s) %iT%iR, TX queues %i, WiFi=%i, BT=%i, GPS=%i, HI PA=%i\n",
2715                  priv->chip_name, cut, priv->chip_vendor, priv->tx_paths,
2716                  priv->rx_paths, priv->ep_tx_count, priv->has_wifi,
2717                  priv->has_bluetooth, priv->has_gps, priv->hi_pa);
2718
2719         dev_info(dev, "RTL%s MAC: %pM\n", priv->chip_name, priv->mac_addr);
2720 }
2721
2722 static int rtl8xxxu_identify_chip(struct rtl8xxxu_priv *priv)
2723 {
2724         struct device *dev = &priv->udev->dev;
2725         u32 val32, bonding;
2726         u16 val16;
2727
2728         val32 = rtl8xxxu_read32(priv, REG_SYS_CFG);
2729         priv->chip_cut = (val32 & SYS_CFG_CHIP_VERSION_MASK) >>
2730                 SYS_CFG_CHIP_VERSION_SHIFT;
2731         if (val32 & SYS_CFG_TRP_VAUX_EN) {
2732                 dev_info(dev, "Unsupported test chip\n");
2733                 return -ENOTSUPP;
2734         }
2735
2736         if (val32 & SYS_CFG_BT_FUNC) {
2737                 if (priv->chip_cut >= 3) {
2738                         sprintf(priv->chip_name, "8723BU");
2739                         priv->rtl_chip = RTL8723B;
2740                 } else {
2741                         sprintf(priv->chip_name, "8723AU");
2742                         priv->usb_interrupts = 1;
2743                         priv->rtl_chip = RTL8723A;
2744                 }
2745
2746                 priv->rf_paths = 1;
2747                 priv->rx_paths = 1;
2748                 priv->tx_paths = 1;
2749
2750                 val32 = rtl8xxxu_read32(priv, REG_MULTI_FUNC_CTRL);
2751                 if (val32 & MULTI_WIFI_FUNC_EN)
2752                         priv->has_wifi = 1;
2753                 if (val32 & MULTI_BT_FUNC_EN)
2754                         priv->has_bluetooth = 1;
2755                 if (val32 & MULTI_GPS_FUNC_EN)
2756                         priv->has_gps = 1;
2757                 priv->is_multi_func = 1;
2758         } else if (val32 & SYS_CFG_TYPE_ID) {
2759                 bonding = rtl8xxxu_read32(priv, REG_HPON_FSM);
2760                 bonding &= HPON_FSM_BONDING_MASK;
2761                 if (priv->fops->tx_desc_size ==
2762                     sizeof(struct rtl8xxxu_txdesc40)) {
2763                         if (bonding == HPON_FSM_BONDING_1T2R) {
2764                                 sprintf(priv->chip_name, "8191EU");
2765                                 priv->rf_paths = 2;
2766                                 priv->rx_paths = 2;
2767                                 priv->tx_paths = 1;
2768                                 priv->rtl_chip = RTL8191E;
2769                         } else {
2770                                 sprintf(priv->chip_name, "8192EU");
2771                                 priv->rf_paths = 2;
2772                                 priv->rx_paths = 2;
2773                                 priv->tx_paths = 2;
2774                                 priv->rtl_chip = RTL8192E;
2775                         }
2776                 } else if (bonding == HPON_FSM_BONDING_1T2R) {
2777                         sprintf(priv->chip_name, "8191CU");
2778                         priv->rf_paths = 2;
2779                         priv->rx_paths = 2;
2780                         priv->tx_paths = 1;
2781                         priv->usb_interrupts = 1;
2782                         priv->rtl_chip = RTL8191C;
2783                 } else {
2784                         sprintf(priv->chip_name, "8192CU");
2785                         priv->rf_paths = 2;
2786                         priv->rx_paths = 2;
2787                         priv->tx_paths = 2;
2788                         priv->usb_interrupts = 1;
2789                         priv->rtl_chip = RTL8192C;
2790                 }
2791                 priv->has_wifi = 1;
2792         } else {
2793                 sprintf(priv->chip_name, "8188CU");
2794                 priv->rf_paths = 1;
2795                 priv->rx_paths = 1;
2796                 priv->tx_paths = 1;
2797                 priv->rtl_chip = RTL8188C;
2798                 priv->usb_interrupts = 1;
2799                 priv->has_wifi = 1;
2800         }
2801
2802         switch (priv->rtl_chip) {
2803         case RTL8188E:
2804         case RTL8192E:
2805         case RTL8723B:
2806                 switch (val32 & SYS_CFG_VENDOR_EXT_MASK) {
2807                 case SYS_CFG_VENDOR_ID_TSMC:
2808                         sprintf(priv->chip_vendor, "TSMC");
2809                         break;
2810                 case SYS_CFG_VENDOR_ID_SMIC:
2811                         sprintf(priv->chip_vendor, "SMIC");
2812                         priv->vendor_smic = 1;
2813                         break;
2814                 case SYS_CFG_VENDOR_ID_UMC:
2815                         sprintf(priv->chip_vendor, "UMC");
2816                         priv->vendor_umc = 1;
2817                         break;
2818                 default:
2819                         sprintf(priv->chip_vendor, "unknown");
2820                 }
2821                 break;
2822         default:
2823                 if (val32 & SYS_CFG_VENDOR_ID) {
2824                         sprintf(priv->chip_vendor, "UMC");
2825                         priv->vendor_umc = 1;
2826                 } else {
2827                         sprintf(priv->chip_vendor, "TSMC");
2828                 }
2829         }
2830
2831         val32 = rtl8xxxu_read32(priv, REG_GPIO_OUTSTS);
2832         priv->rom_rev = (val32 & GPIO_RF_RL_ID) >> 28;
2833
2834         val16 = rtl8xxxu_read16(priv, REG_NORMAL_SIE_EP_TX);
2835         if (val16 & NORMAL_SIE_EP_TX_HIGH_MASK) {
2836                 priv->ep_tx_high_queue = 1;
2837                 priv->ep_tx_count++;
2838         }
2839
2840         if (val16 & NORMAL_SIE_EP_TX_NORMAL_MASK) {
2841                 priv->ep_tx_normal_queue = 1;
2842                 priv->ep_tx_count++;
2843         }
2844
2845         if (val16 & NORMAL_SIE_EP_TX_LOW_MASK) {
2846                 priv->ep_tx_low_queue = 1;
2847                 priv->ep_tx_count++;
2848         }
2849
2850         /*
2851          * Fallback for devices that do not provide REG_NORMAL_SIE_EP_TX
2852          */
2853         if (!priv->ep_tx_count) {
2854                 switch (priv->nr_out_eps) {
2855                 case 4:
2856                 case 3:
2857                         priv->ep_tx_low_queue = 1;
2858                         priv->ep_tx_count++;
2859                 case 2:
2860                         priv->ep_tx_normal_queue = 1;
2861                         priv->ep_tx_count++;
2862                 case 1:
2863                         priv->ep_tx_high_queue = 1;
2864                         priv->ep_tx_count++;
2865                         break;
2866                 default:
2867                         dev_info(dev, "Unsupported USB TX end-points\n");
2868                         return -ENOTSUPP;
2869                 }
2870         }
2871
2872         return 0;
2873 }
2874
2875 static int rtl8723au_parse_efuse(struct rtl8xxxu_priv *priv)
2876 {
2877         struct rtl8723au_efuse *efuse = &priv->efuse_wifi.efuse8723;
2878
2879         if (efuse->rtl_id != cpu_to_le16(0x8129))
2880                 return -EINVAL;
2881
2882         ether_addr_copy(priv->mac_addr, efuse->mac_addr);
2883
2884         memcpy(priv->cck_tx_power_index_A,
2885                efuse->cck_tx_power_index_A,
2886                sizeof(efuse->cck_tx_power_index_A));
2887         memcpy(priv->cck_tx_power_index_B,
2888                efuse->cck_tx_power_index_B,
2889                sizeof(efuse->cck_tx_power_index_B));
2890
2891         memcpy(priv->ht40_1s_tx_power_index_A,
2892                efuse->ht40_1s_tx_power_index_A,
2893                sizeof(efuse->ht40_1s_tx_power_index_A));
2894         memcpy(priv->ht40_1s_tx_power_index_B,
2895                efuse->ht40_1s_tx_power_index_B,
2896                sizeof(efuse->ht40_1s_tx_power_index_B));
2897
2898         memcpy(priv->ht20_tx_power_index_diff,
2899                efuse->ht20_tx_power_index_diff,
2900                sizeof(efuse->ht20_tx_power_index_diff));
2901         memcpy(priv->ofdm_tx_power_index_diff,
2902                efuse->ofdm_tx_power_index_diff,
2903                sizeof(efuse->ofdm_tx_power_index_diff));
2904
2905         memcpy(priv->ht40_max_power_offset,
2906                efuse->ht40_max_power_offset,
2907                sizeof(efuse->ht40_max_power_offset));
2908         memcpy(priv->ht20_max_power_offset,
2909                efuse->ht20_max_power_offset,
2910                sizeof(efuse->ht20_max_power_offset));
2911
2912         if (priv->efuse_wifi.efuse8723.version >= 0x01) {
2913                 priv->has_xtalk = 1;
2914                 priv->xtalk = priv->efuse_wifi.efuse8723.xtal_k & 0x3f;
2915         }
2916         dev_info(&priv->udev->dev, "Vendor: %.7s\n",
2917                  efuse->vendor_name);
2918         dev_info(&priv->udev->dev, "Product: %.41s\n",
2919                  efuse->device_name);
2920         return 0;
2921 }
2922
2923 static int rtl8723bu_parse_efuse(struct rtl8xxxu_priv *priv)
2924 {
2925         struct rtl8723bu_efuse *efuse = &priv->efuse_wifi.efuse8723bu;
2926         int i;
2927
2928         if (efuse->rtl_id != cpu_to_le16(0x8129))
2929                 return -EINVAL;
2930
2931         ether_addr_copy(priv->mac_addr, efuse->mac_addr);
2932
2933         memcpy(priv->cck_tx_power_index_A, efuse->tx_power_index_A.cck_base,
2934                sizeof(efuse->tx_power_index_A.cck_base));
2935         memcpy(priv->cck_tx_power_index_B, efuse->tx_power_index_B.cck_base,
2936                sizeof(efuse->tx_power_index_B.cck_base));
2937
2938         memcpy(priv->ht40_1s_tx_power_index_A,
2939                efuse->tx_power_index_A.ht40_base,
2940                sizeof(efuse->tx_power_index_A.ht40_base));
2941         memcpy(priv->ht40_1s_tx_power_index_B,
2942                efuse->tx_power_index_B.ht40_base,
2943                sizeof(efuse->tx_power_index_B.ht40_base));
2944
2945         priv->ofdm_tx_power_diff[0].a =
2946                 efuse->tx_power_index_A.ht20_ofdm_1s_diff.a;
2947         priv->ofdm_tx_power_diff[0].b =
2948                 efuse->tx_power_index_B.ht20_ofdm_1s_diff.a;
2949
2950         priv->ht20_tx_power_diff[0].a =
2951                 efuse->tx_power_index_A.ht20_ofdm_1s_diff.b;
2952         priv->ht20_tx_power_diff[0].b =
2953                 efuse->tx_power_index_B.ht20_ofdm_1s_diff.b;
2954
2955         priv->ht40_tx_power_diff[0].a = 0;
2956         priv->ht40_tx_power_diff[0].b = 0;
2957
2958         for (i = 1; i < RTL8723B_TX_COUNT; i++) {
2959                 priv->ofdm_tx_power_diff[i].a =
2960                         efuse->tx_power_index_A.pwr_diff[i - 1].ofdm;
2961                 priv->ofdm_tx_power_diff[i].b =
2962                         efuse->tx_power_index_B.pwr_diff[i - 1].ofdm;
2963
2964                 priv->ht20_tx_power_diff[i].a =
2965                         efuse->tx_power_index_A.pwr_diff[i - 1].ht20;
2966                 priv->ht20_tx_power_diff[i].b =
2967                         efuse->tx_power_index_B.pwr_diff[i - 1].ht20;
2968
2969                 priv->ht40_tx_power_diff[i].a =
2970                         efuse->tx_power_index_A.pwr_diff[i - 1].ht40;
2971                 priv->ht40_tx_power_diff[i].b =
2972                         efuse->tx_power_index_B.pwr_diff[i - 1].ht40;
2973         }
2974
2975         priv->has_xtalk = 1;
2976         priv->xtalk = priv->efuse_wifi.efuse8723bu.xtal_k & 0x3f;
2977
2978         dev_info(&priv->udev->dev, "Vendor: %.7s\n", efuse->vendor_name);
2979         dev_info(&priv->udev->dev, "Product: %.41s\n", efuse->device_name);
2980
2981         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_EFUSE) {
2982                 int i;
2983                 unsigned char *raw = priv->efuse_wifi.raw;
2984
2985                 dev_info(&priv->udev->dev,
2986                          "%s: dumping efuse (0x%02zx bytes):\n",
2987                          __func__, sizeof(struct rtl8723bu_efuse));
2988                 for (i = 0; i < sizeof(struct rtl8723bu_efuse); i += 8) {
2989                         dev_info(&priv->udev->dev, "%02x: "
2990                                  "%02x %02x %02x %02x %02x %02x %02x %02x\n", i,
2991                                  raw[i], raw[i + 1], raw[i + 2],
2992                                  raw[i + 3], raw[i + 4], raw[i + 5],
2993                                  raw[i + 6], raw[i + 7]);
2994                 }
2995         }
2996
2997         return 0;
2998 }
2999
3000 #ifdef CONFIG_RTL8XXXU_UNTESTED
3001
3002 static int rtl8192cu_parse_efuse(struct rtl8xxxu_priv *priv)
3003 {
3004         struct rtl8192cu_efuse *efuse = &priv->efuse_wifi.efuse8192;
3005         int i;
3006
3007         if (efuse->rtl_id != cpu_to_le16(0x8129))
3008                 return -EINVAL;
3009
3010         ether_addr_copy(priv->mac_addr, efuse->mac_addr);
3011
3012         memcpy(priv->cck_tx_power_index_A,
3013                efuse->cck_tx_power_index_A,
3014                sizeof(efuse->cck_tx_power_index_A));
3015         memcpy(priv->cck_tx_power_index_B,
3016                efuse->cck_tx_power_index_B,
3017                sizeof(efuse->cck_tx_power_index_B));
3018
3019         memcpy(priv->ht40_1s_tx_power_index_A,
3020                efuse->ht40_1s_tx_power_index_A,
3021                sizeof(efuse->ht40_1s_tx_power_index_A));
3022         memcpy(priv->ht40_1s_tx_power_index_B,
3023                efuse->ht40_1s_tx_power_index_B,
3024                sizeof(efuse->ht40_1s_tx_power_index_B));
3025         memcpy(priv->ht40_2s_tx_power_index_diff,
3026                efuse->ht40_2s_tx_power_index_diff,
3027                sizeof(efuse->ht40_2s_tx_power_index_diff));
3028
3029         memcpy(priv->ht20_tx_power_index_diff,
3030                efuse->ht20_tx_power_index_diff,
3031                sizeof(efuse->ht20_tx_power_index_diff));
3032         memcpy(priv->ofdm_tx_power_index_diff,
3033                efuse->ofdm_tx_power_index_diff,
3034                sizeof(efuse->ofdm_tx_power_index_diff));
3035
3036         memcpy(priv->ht40_max_power_offset,
3037                efuse->ht40_max_power_offset,
3038                sizeof(efuse->ht40_max_power_offset));
3039         memcpy(priv->ht20_max_power_offset,
3040                efuse->ht20_max_power_offset,
3041                sizeof(efuse->ht20_max_power_offset));
3042
3043         dev_info(&priv->udev->dev, "Vendor: %.7s\n",
3044                  efuse->vendor_name);
3045         dev_info(&priv->udev->dev, "Product: %.20s\n",
3046                  efuse->device_name);
3047
3048         if (efuse->rf_regulatory & 0x20) {
3049                 sprintf(priv->chip_name, "8188RU");
3050                 priv->hi_pa = 1;
3051         }
3052
3053         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_EFUSE) {
3054                 unsigned char *raw = priv->efuse_wifi.raw;
3055
3056                 dev_info(&priv->udev->dev,
3057                          "%s: dumping efuse (0x%02zx bytes):\n",
3058                          __func__, sizeof(struct rtl8192cu_efuse));
3059                 for (i = 0; i < sizeof(struct rtl8192cu_efuse); i += 8) {
3060                         dev_info(&priv->udev->dev, "%02x: "
3061                                  "%02x %02x %02x %02x %02x %02x %02x %02x\n", i,
3062                                  raw[i], raw[i + 1], raw[i + 2],
3063                                  raw[i + 3], raw[i + 4], raw[i + 5],
3064                                  raw[i + 6], raw[i + 7]);
3065                 }
3066         }
3067         return 0;
3068 }
3069
3070 #endif
3071
3072 static int rtl8192eu_parse_efuse(struct rtl8xxxu_priv *priv)
3073 {
3074         struct rtl8192eu_efuse *efuse = &priv->efuse_wifi.efuse8192eu;
3075         int i;
3076
3077         if (efuse->rtl_id != cpu_to_le16(0x8129))
3078                 return -EINVAL;
3079
3080         ether_addr_copy(priv->mac_addr, efuse->mac_addr);
3081
3082         memcpy(priv->cck_tx_power_index_A, efuse->tx_power_index_A.cck_base,
3083                sizeof(efuse->tx_power_index_A.cck_base));
3084         memcpy(priv->cck_tx_power_index_B, efuse->tx_power_index_B.cck_base,
3085                sizeof(efuse->tx_power_index_B.cck_base));
3086
3087         memcpy(priv->ht40_1s_tx_power_index_A,
3088                efuse->tx_power_index_A.ht40_base,
3089                sizeof(efuse->tx_power_index_A.ht40_base));
3090         memcpy(priv->ht40_1s_tx_power_index_B,
3091                efuse->tx_power_index_B.ht40_base,
3092                sizeof(efuse->tx_power_index_B.ht40_base));
3093
3094         priv->ht20_tx_power_diff[0].a =
3095                 efuse->tx_power_index_A.ht20_ofdm_1s_diff.b;
3096         priv->ht20_tx_power_diff[0].b =
3097                 efuse->tx_power_index_B.ht20_ofdm_1s_diff.b;
3098
3099         priv->ht40_tx_power_diff[0].a = 0;
3100         priv->ht40_tx_power_diff[0].b = 0;
3101
3102         for (i = 1; i < RTL8723B_TX_COUNT; i++) {
3103                 priv->ofdm_tx_power_diff[i].a =
3104                         efuse->tx_power_index_A.pwr_diff[i - 1].ofdm;
3105                 priv->ofdm_tx_power_diff[i].b =
3106                         efuse->tx_power_index_B.pwr_diff[i - 1].ofdm;
3107
3108                 priv->ht20_tx_power_diff[i].a =
3109                         efuse->tx_power_index_A.pwr_diff[i - 1].ht20;
3110                 priv->ht20_tx_power_diff[i].b =
3111                         efuse->tx_power_index_B.pwr_diff[i - 1].ht20;
3112
3113                 priv->ht40_tx_power_diff[i].a =
3114                         efuse->tx_power_index_A.pwr_diff[i - 1].ht40;
3115                 priv->ht40_tx_power_diff[i].b =
3116                         efuse->tx_power_index_B.pwr_diff[i - 1].ht40;
3117         }
3118
3119         priv->has_xtalk = 1;
3120         priv->xtalk = priv->efuse_wifi.efuse8192eu.xtal_k & 0x3f;
3121
3122         dev_info(&priv->udev->dev, "Vendor: %.7s\n", efuse->vendor_name);
3123         dev_info(&priv->udev->dev, "Product: %.11s\n", efuse->device_name);
3124         dev_info(&priv->udev->dev, "Serial: %.11s\n", efuse->serial);
3125
3126         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_EFUSE) {
3127                 unsigned char *raw = priv->efuse_wifi.raw;
3128
3129                 dev_info(&priv->udev->dev,
3130                          "%s: dumping efuse (0x%02zx bytes):\n",
3131                          __func__, sizeof(struct rtl8192eu_efuse));
3132                 for (i = 0; i < sizeof(struct rtl8192eu_efuse); i += 8) {
3133                         dev_info(&priv->udev->dev, "%02x: "
3134                                  "%02x %02x %02x %02x %02x %02x %02x %02x\n", i,
3135                                  raw[i], raw[i + 1], raw[i + 2],
3136                                  raw[i + 3], raw[i + 4], raw[i + 5],
3137                                  raw[i + 6], raw[i + 7]);
3138                 }
3139         }
3140         /*
3141          * Temporarily disable 8192eu support
3142          */
3143         return -EINVAL;
3144         return 0;
3145 }
3146
3147 static int
3148 rtl8xxxu_read_efuse8(struct rtl8xxxu_priv *priv, u16 offset, u8 *data)
3149 {
3150         int i;
3151         u8 val8;
3152         u32 val32;
3153
3154         /* Write Address */
3155         rtl8xxxu_write8(priv, REG_EFUSE_CTRL + 1, offset & 0xff);
3156         val8 = rtl8xxxu_read8(priv, REG_EFUSE_CTRL + 2);
3157         val8 &= 0xfc;
3158         val8 |= (offset >> 8) & 0x03;
3159         rtl8xxxu_write8(priv, REG_EFUSE_CTRL + 2, val8);
3160
3161         val8 = rtl8xxxu_read8(priv, REG_EFUSE_CTRL + 3);
3162         rtl8xxxu_write8(priv, REG_EFUSE_CTRL + 3, val8 & 0x7f);
3163
3164         /* Poll for data read */
3165         val32 = rtl8xxxu_read32(priv, REG_EFUSE_CTRL);
3166         for (i = 0; i < RTL8XXXU_MAX_REG_POLL; i++) {
3167                 val32 = rtl8xxxu_read32(priv, REG_EFUSE_CTRL);
3168                 if (val32 & BIT(31))
3169                         break;
3170         }
3171
3172         if (i == RTL8XXXU_MAX_REG_POLL)
3173                 return -EIO;
3174
3175         udelay(50);
3176         val32 = rtl8xxxu_read32(priv, REG_EFUSE_CTRL);
3177
3178         *data = val32 & 0xff;
3179         return 0;
3180 }
3181
3182 static int rtl8xxxu_read_efuse(struct rtl8xxxu_priv *priv)
3183 {
3184         struct device *dev = &priv->udev->dev;
3185         int i, ret = 0;
3186         u8 val8, word_mask, header, extheader;
3187         u16 val16, efuse_addr, offset;
3188         u32 val32;
3189
3190         val16 = rtl8xxxu_read16(priv, REG_9346CR);
3191         if (val16 & EEPROM_ENABLE)
3192                 priv->has_eeprom = 1;
3193         if (val16 & EEPROM_BOOT)
3194                 priv->boot_eeprom = 1;
3195
3196         if (priv->is_multi_func) {
3197                 val32 = rtl8xxxu_read32(priv, REG_EFUSE_TEST);
3198                 val32 = (val32 & ~EFUSE_SELECT_MASK) | EFUSE_WIFI_SELECT;
3199                 rtl8xxxu_write32(priv, REG_EFUSE_TEST, val32);
3200         }
3201
3202         dev_dbg(dev, "Booting from %s\n",
3203                 priv->boot_eeprom ? "EEPROM" : "EFUSE");
3204
3205         rtl8xxxu_write8(priv, REG_EFUSE_ACCESS, EFUSE_ACCESS_ENABLE);
3206
3207         /*  1.2V Power: From VDDON with Power Cut(0x0000[15]), default valid */
3208         val16 = rtl8xxxu_read16(priv, REG_SYS_ISO_CTRL);
3209         if (!(val16 & SYS_ISO_PWC_EV12V)) {
3210                 val16 |= SYS_ISO_PWC_EV12V;
3211                 rtl8xxxu_write16(priv, REG_SYS_ISO_CTRL, val16);
3212         }
3213         /*  Reset: 0x0000[28], default valid */
3214         val16 = rtl8xxxu_read16(priv, REG_SYS_FUNC);
3215         if (!(val16 & SYS_FUNC_ELDR)) {
3216                 val16 |= SYS_FUNC_ELDR;
3217                 rtl8xxxu_write16(priv, REG_SYS_FUNC, val16);
3218         }
3219
3220         /*
3221          * Clock: Gated(0x0008[5]) 8M(0x0008[1]) clock from ANA, default valid
3222          */
3223         val16 = rtl8xxxu_read16(priv, REG_SYS_CLKR);
3224         if (!(val16 & SYS_CLK_LOADER_ENABLE) || !(val16 & SYS_CLK_ANA8M)) {
3225                 val16 |= (SYS_CLK_LOADER_ENABLE | SYS_CLK_ANA8M);
3226                 rtl8xxxu_write16(priv, REG_SYS_CLKR, val16);
3227         }
3228
3229         /* Default value is 0xff */
3230         memset(priv->efuse_wifi.raw, 0xff, EFUSE_MAP_LEN);
3231
3232         efuse_addr = 0;
3233         while (efuse_addr < EFUSE_REAL_CONTENT_LEN_8723A) {
3234                 u16 map_addr;
3235
3236                 ret = rtl8xxxu_read_efuse8(priv, efuse_addr++, &header);
3237                 if (ret || header == 0xff)
3238                         goto exit;
3239
3240                 if ((header & 0x1f) == 0x0f) {  /* extended header */
3241                         offset = (header & 0xe0) >> 5;
3242
3243                         ret = rtl8xxxu_read_efuse8(priv, efuse_addr++,
3244                                                    &extheader);
3245                         if (ret)
3246                                 goto exit;
3247                         /* All words disabled */
3248                         if ((extheader & 0x0f) == 0x0f)
3249                                 continue;
3250
3251                         offset |= ((extheader & 0xf0) >> 1);
3252                         word_mask = extheader & 0x0f;
3253                 } else {
3254                         offset = (header >> 4) & 0x0f;
3255                         word_mask = header & 0x0f;
3256                 }
3257
3258                 /* Get word enable value from PG header */
3259
3260                 /* We have 8 bits to indicate validity */
3261                 map_addr = offset * 8;
3262                 if (map_addr >= EFUSE_MAP_LEN) {
3263                         dev_warn(dev, "%s: Illegal map_addr (%04x), "
3264                                  "efuse corrupt!\n",
3265                                  __func__, map_addr);
3266                         ret = -EINVAL;
3267                         goto exit;
3268                 }
3269                 for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) {
3270                         /* Check word enable condition in the section */
3271                         if (word_mask & BIT(i)) {
3272                                 map_addr += 2;
3273                                 continue;
3274                         }
3275
3276                         ret = rtl8xxxu_read_efuse8(priv, efuse_addr++, &val8);
3277                         if (ret)
3278                                 goto exit;
3279                         priv->efuse_wifi.raw[map_addr++] = val8;
3280
3281                         ret = rtl8xxxu_read_efuse8(priv, efuse_addr++, &val8);
3282                         if (ret)
3283                                 goto exit;
3284                         priv->efuse_wifi.raw[map_addr++] = val8;
3285                 }
3286         }
3287
3288 exit:
3289         rtl8xxxu_write8(priv, REG_EFUSE_ACCESS, EFUSE_ACCESS_DISABLE);
3290
3291         return ret;
3292 }
3293
3294 static void rtl8xxxu_reset_8051(struct rtl8xxxu_priv *priv)
3295 {
3296         u8 val8;
3297         u16 sys_func;
3298
3299         val8 = rtl8xxxu_read8(priv, REG_RSV_CTRL + 1);
3300         val8 &= ~BIT(0);
3301         rtl8xxxu_write8(priv, REG_RSV_CTRL + 1, val8);
3302
3303         sys_func = rtl8xxxu_read16(priv, REG_SYS_FUNC);
3304         sys_func &= ~SYS_FUNC_CPU_ENABLE;
3305         rtl8xxxu_write16(priv, REG_SYS_FUNC, sys_func);
3306
3307         val8 = rtl8xxxu_read8(priv, REG_RSV_CTRL + 1);
3308         val8 |= BIT(0);
3309         rtl8xxxu_write8(priv, REG_RSV_CTRL + 1, val8);
3310
3311         sys_func |= SYS_FUNC_CPU_ENABLE;
3312         rtl8xxxu_write16(priv, REG_SYS_FUNC, sys_func);
3313 }
3314
3315 static void rtl8723bu_reset_8051(struct rtl8xxxu_priv *priv)
3316 {
3317         u8 val8;
3318         u16 sys_func;
3319
3320         val8 = rtl8xxxu_read8(priv, REG_RSV_CTRL);
3321         val8 &= ~BIT(1);
3322         rtl8xxxu_write8(priv, REG_RSV_CTRL, val8);
3323
3324         val8 = rtl8xxxu_read8(priv, REG_RSV_CTRL + 1);
3325         val8 &= ~BIT(0);
3326         rtl8xxxu_write8(priv, REG_RSV_CTRL + 1, val8);
3327
3328         sys_func = rtl8xxxu_read16(priv, REG_SYS_FUNC);
3329         sys_func &= ~SYS_FUNC_CPU_ENABLE;
3330         rtl8xxxu_write16(priv, REG_SYS_FUNC, sys_func);
3331
3332         val8 = rtl8xxxu_read8(priv, REG_RSV_CTRL);
3333         val8 &= ~BIT(1);
3334         rtl8xxxu_write8(priv, REG_RSV_CTRL, val8);
3335
3336         val8 = rtl8xxxu_read8(priv, REG_RSV_CTRL + 1);
3337         val8 |= BIT(0);
3338         rtl8xxxu_write8(priv, REG_RSV_CTRL + 1, val8);
3339
3340         sys_func |= SYS_FUNC_CPU_ENABLE;
3341         rtl8xxxu_write16(priv, REG_SYS_FUNC, sys_func);
3342 }
3343
3344 static int rtl8xxxu_start_firmware(struct rtl8xxxu_priv *priv)
3345 {
3346         struct device *dev = &priv->udev->dev;
3347         int ret = 0, i;
3348         u32 val32;
3349
3350         /* Poll checksum report */
3351         for (i = 0; i < RTL8XXXU_FIRMWARE_POLL_MAX; i++) {
3352                 val32 = rtl8xxxu_read32(priv, REG_MCU_FW_DL);
3353                 if (val32 & MCU_FW_DL_CSUM_REPORT)
3354                         break;
3355         }
3356
3357         if (i == RTL8XXXU_FIRMWARE_POLL_MAX) {
3358                 dev_warn(dev, "Firmware checksum poll timed out\n");
3359                 ret = -EAGAIN;
3360                 goto exit;
3361         }
3362
3363         val32 = rtl8xxxu_read32(priv, REG_MCU_FW_DL);
3364         val32 |= MCU_FW_DL_READY;
3365         val32 &= ~MCU_WINT_INIT_READY;
3366         rtl8xxxu_write32(priv, REG_MCU_FW_DL, val32);
3367
3368         /*
3369          * Reset the 8051 in order for the firmware to start running,
3370          * otherwise it won't come up on the 8192eu
3371          */
3372         priv->fops->reset_8051(priv);
3373
3374         /* Wait for firmware to become ready */
3375         for (i = 0; i < RTL8XXXU_FIRMWARE_POLL_MAX; i++) {
3376                 val32 = rtl8xxxu_read32(priv, REG_MCU_FW_DL);
3377                 if (val32 & MCU_WINT_INIT_READY)
3378                         break;
3379
3380                 udelay(100);
3381         }
3382
3383         if (i == RTL8XXXU_FIRMWARE_POLL_MAX) {
3384                 dev_warn(dev, "Firmware failed to start\n");
3385                 ret = -EAGAIN;
3386                 goto exit;
3387         }
3388
3389         /*
3390          * Init H2C command
3391          */
3392         if (priv->rtl_chip == RTL8723B)
3393                 rtl8xxxu_write8(priv, REG_HMTFR, 0x0f);
3394 exit:
3395         return ret;
3396 }
3397
3398 static int rtl8xxxu_download_firmware(struct rtl8xxxu_priv *priv)
3399 {
3400         int pages, remainder, i, ret;
3401         u8 val8;
3402         u16 val16;
3403         u32 val32;
3404         u8 *fwptr;
3405
3406         val8 = rtl8xxxu_read8(priv, REG_SYS_FUNC + 1);
3407         val8 |= 4;
3408         rtl8xxxu_write8(priv, REG_SYS_FUNC + 1, val8);
3409
3410         /* 8051 enable */
3411         val16 = rtl8xxxu_read16(priv, REG_SYS_FUNC);
3412         val16 |= SYS_FUNC_CPU_ENABLE;
3413         rtl8xxxu_write16(priv, REG_SYS_FUNC, val16);
3414
3415         val8 = rtl8xxxu_read8(priv, REG_MCU_FW_DL);
3416         if (val8 & MCU_FW_RAM_SEL) {
3417                 pr_info("do the RAM reset\n");
3418                 rtl8xxxu_write8(priv, REG_MCU_FW_DL, 0x00);
3419                 priv->fops->reset_8051(priv);
3420         }
3421
3422         /* MCU firmware download enable */
3423         val8 = rtl8xxxu_read8(priv, REG_MCU_FW_DL);
3424         val8 |= MCU_FW_DL_ENABLE;
3425         rtl8xxxu_write8(priv, REG_MCU_FW_DL, val8);
3426
3427         /* 8051 reset */
3428         val32 = rtl8xxxu_read32(priv, REG_MCU_FW_DL);
3429         val32 &= ~BIT(19);
3430         rtl8xxxu_write32(priv, REG_MCU_FW_DL, val32);
3431
3432         /* Reset firmware download checksum */
3433         val8 = rtl8xxxu_read8(priv, REG_MCU_FW_DL);
3434         val8 |= MCU_FW_DL_CSUM_REPORT;
3435         rtl8xxxu_write8(priv, REG_MCU_FW_DL, val8);
3436
3437         pages = priv->fw_size / RTL_FW_PAGE_SIZE;
3438         remainder = priv->fw_size % RTL_FW_PAGE_SIZE;
3439
3440         fwptr = priv->fw_data->data;
3441
3442         for (i = 0; i < pages; i++) {
3443                 val8 = rtl8xxxu_read8(priv, REG_MCU_FW_DL + 2) & 0xF8;
3444                 val8 |= i;
3445                 rtl8xxxu_write8(priv, REG_MCU_FW_DL + 2, val8);
3446
3447                 ret = rtl8xxxu_writeN(priv, REG_FW_START_ADDRESS,
3448                                       fwptr, RTL_FW_PAGE_SIZE);
3449                 if (ret != RTL_FW_PAGE_SIZE) {
3450                         ret = -EAGAIN;
3451                         goto fw_abort;
3452                 }
3453
3454                 fwptr += RTL_FW_PAGE_SIZE;
3455         }
3456
3457         if (remainder) {
3458                 val8 = rtl8xxxu_read8(priv, REG_MCU_FW_DL + 2) & 0xF8;
3459                 val8 |= i;
3460                 rtl8xxxu_write8(priv, REG_MCU_FW_DL + 2, val8);
3461                 ret = rtl8xxxu_writeN(priv, REG_FW_START_ADDRESS,
3462                                       fwptr, remainder);
3463                 if (ret != remainder) {
3464                         ret = -EAGAIN;
3465                         goto fw_abort;
3466                 }
3467         }
3468
3469         ret = 0;
3470 fw_abort:
3471         /* MCU firmware download disable */
3472         val16 = rtl8xxxu_read16(priv, REG_MCU_FW_DL);
3473         val16 &= ~MCU_FW_DL_ENABLE;
3474         rtl8xxxu_write16(priv, REG_MCU_FW_DL, val16);
3475
3476         return ret;
3477 }
3478
3479 static int rtl8xxxu_load_firmware(struct rtl8xxxu_priv *priv, char *fw_name)
3480 {
3481         struct device *dev = &priv->udev->dev;
3482         const struct firmware *fw;
3483         int ret = 0;
3484         u16 signature;
3485
3486         dev_info(dev, "%s: Loading firmware %s\n", DRIVER_NAME, fw_name);
3487         if (request_firmware(&fw, fw_name, &priv->udev->dev)) {
3488                 dev_warn(dev, "request_firmware(%s) failed\n", fw_name);
3489                 ret = -EAGAIN;
3490                 goto exit;
3491         }
3492         if (!fw) {
3493                 dev_warn(dev, "Firmware data not available\n");
3494                 ret = -EINVAL;
3495                 goto exit;
3496         }
3497
3498         priv->fw_data = kmemdup(fw->data, fw->size, GFP_KERNEL);
3499         if (!priv->fw_data) {
3500                 ret = -ENOMEM;
3501                 goto exit;
3502         }
3503         priv->fw_size = fw->size - sizeof(struct rtl8xxxu_firmware_header);
3504
3505         signature = le16_to_cpu(priv->fw_data->signature);
3506         switch (signature & 0xfff0) {
3507         case 0x92e0:
3508         case 0x92c0:
3509         case 0x88c0:
3510         case 0x5300:
3511         case 0x2300:
3512                 break;
3513         default:
3514                 ret = -EINVAL;
3515                 dev_warn(dev, "%s: Invalid firmware signature: 0x%04x\n",
3516                          __func__, signature);
3517         }
3518
3519         dev_info(dev, "Firmware revision %i.%i (signature 0x%04x)\n",
3520                  le16_to_cpu(priv->fw_data->major_version),
3521                  priv->fw_data->minor_version, signature);
3522
3523 exit:
3524         release_firmware(fw);
3525         return ret;
3526 }
3527
3528 static int rtl8723au_load_firmware(struct rtl8xxxu_priv *priv)
3529 {
3530         char *fw_name;
3531         int ret;
3532
3533         switch (priv->chip_cut) {
3534         case 0:
3535                 fw_name = "rtlwifi/rtl8723aufw_A.bin";
3536                 break;
3537         case 1:
3538                 if (priv->enable_bluetooth)
3539                         fw_name = "rtlwifi/rtl8723aufw_B.bin";
3540                 else
3541                         fw_name = "rtlwifi/rtl8723aufw_B_NoBT.bin";
3542
3543                 break;
3544         default:
3545                 return -EINVAL;
3546         }
3547
3548         ret = rtl8xxxu_load_firmware(priv, fw_name);
3549         return ret;
3550 }
3551
3552 static int rtl8723bu_load_firmware(struct rtl8xxxu_priv *priv)
3553 {
3554         char *fw_name;
3555         int ret;
3556
3557         if (priv->enable_bluetooth)
3558                 fw_name = "rtlwifi/rtl8723bu_bt.bin";
3559         else
3560                 fw_name = "rtlwifi/rtl8723bu_nic.bin";
3561
3562         ret = rtl8xxxu_load_firmware(priv, fw_name);
3563         return ret;
3564 }
3565
3566 #ifdef CONFIG_RTL8XXXU_UNTESTED
3567
3568 static int rtl8192cu_load_firmware(struct rtl8xxxu_priv *priv)
3569 {
3570         char *fw_name;
3571         int ret;
3572
3573         if (!priv->vendor_umc)
3574                 fw_name = "rtlwifi/rtl8192cufw_TMSC.bin";
3575         else if (priv->chip_cut || priv->rtl_chip == RTL8192C)
3576                 fw_name = "rtlwifi/rtl8192cufw_B.bin";
3577         else
3578                 fw_name = "rtlwifi/rtl8192cufw_A.bin";
3579
3580         ret = rtl8xxxu_load_firmware(priv, fw_name);
3581
3582         return ret;
3583 }
3584
3585 #endif
3586
3587 static int rtl8192eu_load_firmware(struct rtl8xxxu_priv *priv)
3588 {
3589         char *fw_name;
3590         int ret;
3591
3592         fw_name = "rtlwifi/rtl8192eu_nic.bin";
3593
3594         ret = rtl8xxxu_load_firmware(priv, fw_name);
3595
3596         return ret;
3597 }
3598
3599 static void rtl8xxxu_firmware_self_reset(struct rtl8xxxu_priv *priv)
3600 {
3601         u16 val16;
3602         int i = 100;
3603
3604         /* Inform 8051 to perform reset */
3605         rtl8xxxu_write8(priv, REG_HMTFR + 3, 0x20);
3606
3607         for (i = 100; i > 0; i--) {
3608                 val16 = rtl8xxxu_read16(priv, REG_SYS_FUNC);
3609
3610                 if (!(val16 & SYS_FUNC_CPU_ENABLE)) {
3611                         dev_dbg(&priv->udev->dev,
3612                                 "%s: Firmware self reset success!\n", __func__);
3613                         break;
3614                 }
3615                 udelay(50);
3616         }
3617
3618         if (!i) {
3619                 /* Force firmware reset */
3620                 val16 = rtl8xxxu_read16(priv, REG_SYS_FUNC);
3621                 val16 &= ~SYS_FUNC_CPU_ENABLE;
3622                 rtl8xxxu_write16(priv, REG_SYS_FUNC, val16);
3623         }
3624 }
3625
3626 static void rtl8723bu_phy_init_antenna_selection(struct rtl8xxxu_priv *priv)
3627 {
3628         u32 val32;
3629
3630         val32 = rtl8xxxu_read32(priv, REG_PAD_CTRL1);
3631         val32 &= ~(BIT(20) | BIT(24));
3632         rtl8xxxu_write32(priv, REG_PAD_CTRL1, val32);
3633
3634         val32 = rtl8xxxu_read32(priv, REG_GPIO_MUXCFG);
3635         val32 &= ~BIT(4);
3636         rtl8xxxu_write32(priv, REG_GPIO_MUXCFG, val32);
3637
3638         val32 = rtl8xxxu_read32(priv, REG_GPIO_MUXCFG);
3639         val32 |= BIT(3);
3640         rtl8xxxu_write32(priv, REG_GPIO_MUXCFG, val32);
3641
3642         val32 = rtl8xxxu_read32(priv, REG_LEDCFG0);
3643         val32 |= BIT(24);
3644         rtl8xxxu_write32(priv, REG_LEDCFG0, val32);
3645
3646         val32 = rtl8xxxu_read32(priv, REG_LEDCFG0);
3647         val32 &= ~BIT(23);
3648         rtl8xxxu_write32(priv, REG_LEDCFG0, val32);
3649
3650         val32 = rtl8xxxu_read32(priv, REG_RFE_BUFFER);
3651         val32 |= (BIT(0) | BIT(1));
3652         rtl8xxxu_write32(priv, REG_RFE_BUFFER, val32);
3653
3654         val32 = rtl8xxxu_read32(priv, REG_RFE_CTRL_ANTA_SRC);
3655         val32 &= 0xffffff00;
3656         val32 |= 0x77;
3657         rtl8xxxu_write32(priv, REG_RFE_CTRL_ANTA_SRC, val32);
3658
3659         val32 = rtl8xxxu_read32(priv, REG_PWR_DATA);
3660         val32 |= PWR_DATA_EEPRPAD_RFE_CTRL_EN;
3661         rtl8xxxu_write32(priv, REG_PWR_DATA, val32);
3662 }
3663
3664 static int
3665 rtl8xxxu_init_mac(struct rtl8xxxu_priv *priv)
3666 {
3667         struct rtl8xxxu_reg8val *array = priv->fops->mactable;
3668         int i, ret;
3669         u16 reg;
3670         u8 val;
3671
3672         for (i = 0; ; i++) {
3673                 reg = array[i].reg;
3674                 val = array[i].val;
3675
3676                 if (reg == 0xffff && val == 0xff)
3677                         break;
3678
3679                 ret = rtl8xxxu_write8(priv, reg, val);
3680                 if (ret != 1) {
3681                         dev_warn(&priv->udev->dev,
3682                                  "Failed to initialize MAC "
3683                                  "(reg: %04x, val %02x)\n", reg, val);
3684                         return -EAGAIN;
3685                 }
3686         }
3687
3688         if (priv->rtl_chip != RTL8723B && priv->rtl_chip != RTL8192E)
3689                 rtl8xxxu_write8(priv, REG_MAX_AGGR_NUM, 0x0a);
3690
3691         return 0;
3692 }
3693
3694 static int rtl8xxxu_init_phy_regs(struct rtl8xxxu_priv *priv,
3695                                   struct rtl8xxxu_reg32val *array)
3696 {
3697         int i, ret;
3698         u16 reg;
3699         u32 val;
3700
3701         for (i = 0; ; i++) {
3702                 reg = array[i].reg;
3703                 val = array[i].val;
3704
3705                 if (reg == 0xffff && val == 0xffffffff)
3706                         break;
3707
3708                 ret = rtl8xxxu_write32(priv, reg, val);
3709                 if (ret != sizeof(val)) {
3710                         dev_warn(&priv->udev->dev,
3711                                  "Failed to initialize PHY\n");
3712                         return -EAGAIN;
3713                 }
3714                 udelay(1);
3715         }
3716
3717         return 0;
3718 }
3719
3720 /*
3721  * Most of this is black magic retrieved from the old rtl8723au driver
3722  */
3723 static int rtl8xxxu_init_phy_bb(struct rtl8xxxu_priv *priv)
3724 {
3725         u8 val8, ldoa15, ldov12d, lpldo, ldohci12;
3726         u16 val16;
3727         u32 val32;
3728
3729         /*
3730          * Todo: The vendor driver maintains a table of PHY register
3731          *       addresses, which is initialized here. Do we need this?
3732          */
3733
3734         if (priv->rtl_chip == RTL8723B) {
3735                 val16 = rtl8xxxu_read16(priv, REG_SYS_FUNC);
3736                 val16 |= SYS_FUNC_BB_GLB_RSTN | SYS_FUNC_BBRSTB |
3737                         SYS_FUNC_DIO_RF;
3738                 rtl8xxxu_write16(priv, REG_SYS_FUNC, val16);
3739
3740                 rtl8xxxu_write32(priv, REG_S0S1_PATH_SWITCH, 0x00);
3741         } else if (priv->rtl_chip == RTL8192E) {
3742                 val16 = rtl8xxxu_read16(priv, REG_SYS_FUNC);
3743                 val16 |= SYS_FUNC_BB_GLB_RSTN | SYS_FUNC_BBRSTB |
3744                         SYS_FUNC_DIO_RF;
3745                 rtl8xxxu_write16(priv, REG_SYS_FUNC, val16);
3746         } else {
3747                 val8 = rtl8xxxu_read8(priv, REG_AFE_PLL_CTRL);
3748                 udelay(2);
3749                 val8 |= AFE_PLL_320_ENABLE;
3750                 rtl8xxxu_write8(priv, REG_AFE_PLL_CTRL, val8);
3751                 udelay(2);
3752
3753                 rtl8xxxu_write8(priv, REG_AFE_PLL_CTRL + 1, 0xff);
3754                 udelay(2);
3755
3756                 val16 = rtl8xxxu_read16(priv, REG_SYS_FUNC);
3757                 val16 |= SYS_FUNC_BB_GLB_RSTN | SYS_FUNC_BBRSTB;
3758                 rtl8xxxu_write16(priv, REG_SYS_FUNC, val16);
3759         }
3760
3761         if (priv->rtl_chip != RTL8723B && priv->rtl_chip != RTL8192E) {
3762                 /* AFE_XTAL_RF_GATE (bit 14) if addressing as 32 bit register */
3763                 val32 = rtl8xxxu_read32(priv, REG_AFE_XTAL_CTRL);
3764                 val32 &= ~AFE_XTAL_RF_GATE;
3765                 if (priv->has_bluetooth)
3766                         val32 &= ~AFE_XTAL_BT_GATE;
3767                 rtl8xxxu_write32(priv, REG_AFE_XTAL_CTRL, val32);
3768         }
3769
3770         /* 6. 0x1f[7:0] = 0x07 */
3771         val8 = RF_ENABLE | RF_RSTB | RF_SDMRSTB;
3772         rtl8xxxu_write8(priv, REG_RF_CTRL, val8);
3773
3774         if (priv->rtl_chip == RTL8723B) {
3775                 /*
3776                  * Why?
3777                  */
3778                 rtl8xxxu_write8(priv, REG_SYS_FUNC, 0xe3);
3779                 rtl8xxxu_write8(priv, REG_AFE_XTAL_CTRL + 1, 0x80);
3780                 rtl8xxxu_init_phy_regs(priv, rtl8723b_phy_1t_init_table);
3781         } else if (priv->rtl_chip == RTL8192E) {
3782                 val16 = rtl8xxxu_read16(priv, REG_SYS_FUNC);
3783                 val16 |= (SYS_FUNC_USBA | SYS_FUNC_USBD | SYS_FUNC_DIO_RF |
3784                           SYS_FUNC_BB_GLB_RSTN | SYS_FUNC_BBRSTB);
3785                 rtl8xxxu_write16(priv, REG_SYS_FUNC, val16);
3786                 val8 = RF_ENABLE | RF_RSTB | RF_SDMRSTB;
3787                 rtl8xxxu_write8(priv, REG_RF_CTRL, val8);
3788                 rtl8xxxu_init_phy_regs(priv, rtl8192eu_phy_init_table);
3789         } else  if (priv->hi_pa)
3790                 rtl8xxxu_init_phy_regs(priv, rtl8188ru_phy_1t_highpa_table);
3791         else if (priv->tx_paths == 2)
3792                 rtl8xxxu_init_phy_regs(priv, rtl8192cu_phy_2t_init_table);
3793         else
3794                 rtl8xxxu_init_phy_regs(priv, rtl8723a_phy_1t_init_table);
3795
3796         if (priv->rtl_chip == RTL8188C && priv->hi_pa &&
3797             priv->vendor_umc && priv->chip_cut == 1)
3798                 rtl8xxxu_write8(priv, REG_OFDM0_AGC_PARM1 + 2, 0x50);
3799
3800         if (priv->tx_paths == 1 && priv->rx_paths == 2) {
3801                 /*
3802                  * For 1T2R boards, patch the registers.
3803                  *
3804                  * It looks like 8191/2 1T2R boards use path B for TX
3805                  */
3806                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_TX_INFO);
3807                 val32 &= ~(BIT(0) | BIT(1));
3808                 val32 |= BIT(1);
3809                 rtl8xxxu_write32(priv, REG_FPGA0_TX_INFO, val32);
3810
3811                 val32 = rtl8xxxu_read32(priv, REG_FPGA1_TX_INFO);
3812                 val32 &= ~0x300033;
3813                 val32 |= 0x200022;
3814                 rtl8xxxu_write32(priv, REG_FPGA1_TX_INFO, val32);
3815
3816                 val32 = rtl8xxxu_read32(priv, REG_CCK0_AFE_SETTING);
3817                 val32 &= 0xff000000;
3818                 val32 |= 0x45000000;
3819                 rtl8xxxu_write32(priv, REG_CCK0_AFE_SETTING, val32);
3820
3821                 val32 = rtl8xxxu_read32(priv, REG_OFDM0_TRX_PATH_ENABLE);
3822                 val32 &= ~(OFDM_RF_PATH_RX_MASK | OFDM_RF_PATH_TX_MASK);
3823                 val32 |= (OFDM_RF_PATH_RX_A | OFDM_RF_PATH_RX_B |
3824                           OFDM_RF_PATH_TX_B);
3825                 rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, val32);
3826
3827                 val32 = rtl8xxxu_read32(priv, REG_OFDM0_AGC_PARM1);
3828                 val32 &= ~(BIT(4) | BIT(5));
3829                 val32 |= BIT(4);
3830                 rtl8xxxu_write32(priv, REG_OFDM0_AGC_PARM1, val32);
3831
3832                 val32 = rtl8xxxu_read32(priv, REG_TX_CCK_RFON);
3833                 val32 &= ~(BIT(27) | BIT(26));
3834                 val32 |= BIT(27);
3835                 rtl8xxxu_write32(priv, REG_TX_CCK_RFON, val32);
3836
3837                 val32 = rtl8xxxu_read32(priv, REG_TX_CCK_BBON);
3838                 val32 &= ~(BIT(27) | BIT(26));
3839                 val32 |= BIT(27);
3840                 rtl8xxxu_write32(priv, REG_TX_CCK_BBON, val32);
3841
3842                 val32 = rtl8xxxu_read32(priv, REG_TX_OFDM_RFON);
3843                 val32 &= ~(BIT(27) | BIT(26));
3844                 val32 |= BIT(27);
3845                 rtl8xxxu_write32(priv, REG_TX_OFDM_RFON, val32);
3846
3847                 val32 = rtl8xxxu_read32(priv, REG_TX_OFDM_BBON);
3848                 val32 &= ~(BIT(27) | BIT(26));
3849                 val32 |= BIT(27);
3850                 rtl8xxxu_write32(priv, REG_TX_OFDM_BBON, val32);
3851
3852                 val32 = rtl8xxxu_read32(priv, REG_TX_TO_TX);
3853                 val32 &= ~(BIT(27) | BIT(26));
3854                 val32 |= BIT(27);
3855                 rtl8xxxu_write32(priv, REG_TX_TO_TX, val32);
3856         }
3857
3858         if (priv->rtl_chip == RTL8723B)
3859                 rtl8xxxu_init_phy_regs(priv, rtl8xxx_agc_8723bu_table);
3860         else if (priv->rtl_chip == RTL8192E) {
3861                 if (priv->hi_pa)
3862                         rtl8xxxu_init_phy_regs(priv,
3863                                                rtl8xxx_agc_8192eu_highpa_table);
3864                 else
3865                         rtl8xxxu_init_phy_regs(priv,
3866                                                rtl8xxx_agc_8192eu_std_table);
3867         } else if (priv->hi_pa)
3868                 rtl8xxxu_init_phy_regs(priv, rtl8xxx_agc_highpa_table);
3869         else
3870                 rtl8xxxu_init_phy_regs(priv, rtl8xxx_agc_standard_table);
3871
3872         if (priv->has_xtalk) {
3873                 val32 = rtl8xxxu_read32(priv, REG_MAC_PHY_CTRL);
3874
3875                 val8 = priv->xtalk;
3876                 val32 &= 0xff000fff;
3877                 val32 |= ((val8 | (val8 << 6)) << 12);
3878
3879                 rtl8xxxu_write32(priv, REG_MAC_PHY_CTRL, val32);
3880         }
3881
3882         if (priv->rtl_chip != RTL8723B && priv->rtl_chip != RTL8192E) {
3883                 ldoa15 = LDOA15_ENABLE | LDOA15_OBUF;
3884                 ldov12d = LDOV12D_ENABLE | BIT(2) | (2 << LDOV12D_VADJ_SHIFT);
3885                 ldohci12 = 0x57;
3886                 lpldo = 1;
3887                 val32 = (lpldo << 24) | (ldohci12 << 16) |
3888                         (ldov12d << 8) | ldoa15;
3889
3890                 rtl8xxxu_write32(priv, REG_LDOA15_CTRL, val32);
3891         }
3892
3893         if (priv->rtl_chip == RTL8192E)
3894                 rtl8xxxu_write32(priv, REG_AFE_XTAL_CTRL, 0x000f81fb);
3895
3896         return 0;
3897 }
3898
3899 static int rtl8xxxu_init_rf_regs(struct rtl8xxxu_priv *priv,
3900                                  struct rtl8xxxu_rfregval *array,
3901                                  enum rtl8xxxu_rfpath path)
3902 {
3903         int i, ret;
3904         u8 reg;
3905         u32 val;
3906
3907         for (i = 0; ; i++) {
3908                 reg = array[i].reg;
3909                 val = array[i].val;
3910
3911                 if (reg == 0xff && val == 0xffffffff)
3912                         break;
3913
3914                 switch (reg) {
3915                 case 0xfe:
3916                         msleep(50);
3917                         continue;
3918                 case 0xfd:
3919                         mdelay(5);
3920                         continue;
3921                 case 0xfc:
3922                         mdelay(1);
3923                         continue;
3924                 case 0xfb:
3925                         udelay(50);
3926                         continue;
3927                 case 0xfa:
3928                         udelay(5);
3929                         continue;
3930                 case 0xf9:
3931                         udelay(1);
3932                         continue;
3933                 }
3934
3935                 ret = rtl8xxxu_write_rfreg(priv, path, reg, val);
3936                 if (ret) {
3937                         dev_warn(&priv->udev->dev,
3938                                  "Failed to initialize RF\n");
3939                         return -EAGAIN;
3940                 }
3941                 udelay(1);
3942         }
3943
3944         return 0;
3945 }
3946
3947 static int rtl8xxxu_init_phy_rf(struct rtl8xxxu_priv *priv,
3948                                 struct rtl8xxxu_rfregval *table,
3949                                 enum rtl8xxxu_rfpath path)
3950 {
3951         u32 val32;
3952         u16 val16, rfsi_rfenv;
3953         u16 reg_sw_ctrl, reg_int_oe, reg_hssi_parm2;
3954
3955         switch (path) {
3956         case RF_A:
3957                 reg_sw_ctrl = REG_FPGA0_XA_RF_SW_CTRL;
3958                 reg_int_oe = REG_FPGA0_XA_RF_INT_OE;
3959                 reg_hssi_parm2 = REG_FPGA0_XA_HSSI_PARM2;
3960                 break;
3961         case RF_B:
3962                 reg_sw_ctrl = REG_FPGA0_XB_RF_SW_CTRL;
3963                 reg_int_oe = REG_FPGA0_XB_RF_INT_OE;
3964                 reg_hssi_parm2 = REG_FPGA0_XB_HSSI_PARM2;
3965                 break;
3966         default:
3967                 dev_err(&priv->udev->dev, "%s:Unsupported RF path %c\n",
3968                         __func__, path + 'A');
3969                 return -EINVAL;
3970         }
3971         /* For path B, use XB */
3972         rfsi_rfenv = rtl8xxxu_read16(priv, reg_sw_ctrl);
3973         rfsi_rfenv &= FPGA0_RF_RFENV;
3974
3975         /*
3976          * These two we might be able to optimize into one
3977          */
3978         val32 = rtl8xxxu_read32(priv, reg_int_oe);
3979         val32 |= BIT(20);       /* 0x10 << 16 */
3980         rtl8xxxu_write32(priv, reg_int_oe, val32);
3981         udelay(1);
3982
3983         val32 = rtl8xxxu_read32(priv, reg_int_oe);
3984         val32 |= BIT(4);
3985         rtl8xxxu_write32(priv, reg_int_oe, val32);
3986         udelay(1);
3987
3988         /*
3989          * These two we might be able to optimize into one
3990          */
3991         val32 = rtl8xxxu_read32(priv, reg_hssi_parm2);
3992         val32 &= ~FPGA0_HSSI_3WIRE_ADDR_LEN;
3993         rtl8xxxu_write32(priv, reg_hssi_parm2, val32);
3994         udelay(1);
3995
3996         val32 = rtl8xxxu_read32(priv, reg_hssi_parm2);
3997         val32 &= ~FPGA0_HSSI_3WIRE_DATA_LEN;
3998         rtl8xxxu_write32(priv, reg_hssi_parm2, val32);
3999         udelay(1);
4000
4001         rtl8xxxu_init_rf_regs(priv, table, path);
4002
4003         /* For path B, use XB */
4004         val16 = rtl8xxxu_read16(priv, reg_sw_ctrl);
4005         val16 &= ~FPGA0_RF_RFENV;
4006         val16 |= rfsi_rfenv;
4007         rtl8xxxu_write16(priv, reg_sw_ctrl, val16);
4008
4009         return 0;
4010 }
4011
4012 static int rtl8xxxu_llt_write(struct rtl8xxxu_priv *priv, u8 address, u8 data)
4013 {
4014         int ret = -EBUSY;
4015         int count = 0;
4016         u32 value;
4017
4018         value = LLT_OP_WRITE | address << 8 | data;
4019
4020         rtl8xxxu_write32(priv, REG_LLT_INIT, value);
4021
4022         do {
4023                 value = rtl8xxxu_read32(priv, REG_LLT_INIT);
4024                 if ((value & LLT_OP_MASK) == LLT_OP_INACTIVE) {
4025                         ret = 0;
4026                         break;
4027                 }
4028         } while (count++ < 20);
4029
4030         return ret;
4031 }
4032
4033 static int rtl8xxxu_init_llt_table(struct rtl8xxxu_priv *priv, u8 last_tx_page)
4034 {
4035         int ret;
4036         int i;
4037
4038         for (i = 0; i < last_tx_page; i++) {
4039                 ret = rtl8xxxu_llt_write(priv, i, i + 1);
4040                 if (ret)
4041                         goto exit;
4042         }
4043
4044         ret = rtl8xxxu_llt_write(priv, last_tx_page, 0xff);
4045         if (ret)
4046                 goto exit;
4047
4048         /* Mark remaining pages as a ring buffer */
4049         for (i = last_tx_page + 1; i < 0xff; i++) {
4050                 ret = rtl8xxxu_llt_write(priv, i, (i + 1));
4051                 if (ret)
4052                         goto exit;
4053         }
4054
4055         /*  Let last entry point to the start entry of ring buffer */
4056         ret = rtl8xxxu_llt_write(priv, 0xff, last_tx_page + 1);
4057         if (ret)
4058                 goto exit;
4059
4060 exit:
4061         return ret;
4062 }
4063
4064 static int rtl8xxxu_auto_llt_table(struct rtl8xxxu_priv *priv, u8 last_tx_page)
4065 {
4066         u32 val32;
4067         int ret = 0;
4068         int i;
4069
4070         val32 = rtl8xxxu_read32(priv, REG_AUTO_LLT);
4071         val32 |= AUTO_LLT_INIT_LLT;
4072         rtl8xxxu_write32(priv, REG_AUTO_LLT, val32);
4073
4074         for (i = 500; i; i--) {
4075                 val32 = rtl8xxxu_read32(priv, REG_AUTO_LLT);
4076                 if (!(val32 & AUTO_LLT_INIT_LLT))
4077                         break;
4078                 usleep_range(2, 4);
4079         }
4080
4081         if (!i) {
4082                 ret = -EBUSY;
4083                 dev_warn(&priv->udev->dev, "LLT table init failed\n");
4084         }
4085
4086         return ret;
4087 }
4088
4089 static int rtl8xxxu_init_queue_priority(struct rtl8xxxu_priv *priv)
4090 {
4091         u16 val16, hi, lo;
4092         u16 hiq, mgq, bkq, beq, viq, voq;
4093         int hip, mgp, bkp, bep, vip, vop;
4094         int ret = 0;
4095
4096         switch (priv->ep_tx_count) {
4097         case 1:
4098                 if (priv->ep_tx_high_queue) {
4099                         hi = TRXDMA_QUEUE_HIGH;
4100                 } else if (priv->ep_tx_low_queue) {
4101                         hi = TRXDMA_QUEUE_LOW;
4102                 } else if (priv->ep_tx_normal_queue) {
4103                         hi = TRXDMA_QUEUE_NORMAL;
4104                 } else {
4105                         hi = 0;
4106                         ret = -EINVAL;
4107                 }
4108
4109                 hiq = hi;
4110                 mgq = hi;
4111                 bkq = hi;
4112                 beq = hi;
4113                 viq = hi;
4114                 voq = hi;
4115
4116                 hip = 0;
4117                 mgp = 0;
4118                 bkp = 0;
4119                 bep = 0;
4120                 vip = 0;
4121                 vop = 0;
4122                 break;
4123         case 2:
4124                 if (priv->ep_tx_high_queue && priv->ep_tx_low_queue) {
4125                         hi = TRXDMA_QUEUE_HIGH;
4126                         lo = TRXDMA_QUEUE_LOW;
4127                 } else if (priv->ep_tx_normal_queue && priv->ep_tx_low_queue) {
4128                         hi = TRXDMA_QUEUE_NORMAL;
4129                         lo = TRXDMA_QUEUE_LOW;
4130                 } else if (priv->ep_tx_high_queue && priv->ep_tx_normal_queue) {
4131                         hi = TRXDMA_QUEUE_HIGH;
4132                         lo = TRXDMA_QUEUE_NORMAL;
4133                 } else {
4134                         ret = -EINVAL;
4135                         hi = 0;
4136                         lo = 0;
4137                 }
4138
4139                 hiq = hi;
4140                 mgq = hi;
4141                 bkq = lo;
4142                 beq = lo;
4143                 viq = hi;
4144                 voq = hi;
4145
4146                 hip = 0;
4147                 mgp = 0;
4148                 bkp = 1;
4149                 bep = 1;
4150                 vip = 0;
4151                 vop = 0;
4152                 break;
4153         case 3:
4154                 beq = TRXDMA_QUEUE_LOW;
4155                 bkq = TRXDMA_QUEUE_LOW;
4156                 viq = TRXDMA_QUEUE_NORMAL;
4157                 voq = TRXDMA_QUEUE_HIGH;
4158                 mgq = TRXDMA_QUEUE_HIGH;
4159                 hiq = TRXDMA_QUEUE_HIGH;
4160
4161                 hip = hiq ^ 3;
4162                 mgp = mgq ^ 3;
4163                 bkp = bkq ^ 3;
4164                 bep = beq ^ 3;
4165                 vip = viq ^ 3;
4166                 vop = viq ^ 3;
4167                 break;
4168         default:
4169                 ret = -EINVAL;
4170         }
4171
4172         /*
4173          * None of the vendor drivers are configuring the beacon
4174          * queue here .... why?
4175          */
4176         if (!ret) {
4177                 val16 = rtl8xxxu_read16(priv, REG_TRXDMA_CTRL);
4178                 val16 &= 0x7;
4179                 val16 |= (voq << TRXDMA_CTRL_VOQ_SHIFT) |
4180                         (viq << TRXDMA_CTRL_VIQ_SHIFT) |
4181                         (beq << TRXDMA_CTRL_BEQ_SHIFT) |
4182                         (bkq << TRXDMA_CTRL_BKQ_SHIFT) |
4183                         (mgq << TRXDMA_CTRL_MGQ_SHIFT) |
4184                         (hiq << TRXDMA_CTRL_HIQ_SHIFT);
4185                 rtl8xxxu_write16(priv, REG_TRXDMA_CTRL, val16);
4186
4187                 priv->pipe_out[TXDESC_QUEUE_VO] =
4188                         usb_sndbulkpipe(priv->udev, priv->out_ep[vop]);
4189                 priv->pipe_out[TXDESC_QUEUE_VI] =
4190                         usb_sndbulkpipe(priv->udev, priv->out_ep[vip]);
4191                 priv->pipe_out[TXDESC_QUEUE_BE] =
4192                         usb_sndbulkpipe(priv->udev, priv->out_ep[bep]);
4193                 priv->pipe_out[TXDESC_QUEUE_BK] =
4194                         usb_sndbulkpipe(priv->udev, priv->out_ep[bkp]);
4195                 priv->pipe_out[TXDESC_QUEUE_BEACON] =
4196                         usb_sndbulkpipe(priv->udev, priv->out_ep[0]);
4197                 priv->pipe_out[TXDESC_QUEUE_MGNT] =
4198                         usb_sndbulkpipe(priv->udev, priv->out_ep[mgp]);
4199                 priv->pipe_out[TXDESC_QUEUE_HIGH] =
4200                         usb_sndbulkpipe(priv->udev, priv->out_ep[hip]);
4201                 priv->pipe_out[TXDESC_QUEUE_CMD] =
4202                         usb_sndbulkpipe(priv->udev, priv->out_ep[0]);
4203         }
4204
4205         return ret;
4206 }
4207
4208 static void rtl8xxxu_fill_iqk_matrix_a(struct rtl8xxxu_priv *priv,
4209                                        bool iqk_ok, int result[][8],
4210                                        int candidate, bool tx_only)
4211 {
4212         u32 oldval, x, tx0_a, reg;
4213         int y, tx0_c;
4214         u32 val32;
4215
4216         if (!iqk_ok)
4217                 return;
4218
4219         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XA_TX_IQ_IMBALANCE);
4220         oldval = val32 >> 22;
4221
4222         x = result[candidate][0];
4223         if ((x & 0x00000200) != 0)
4224                 x = x | 0xfffffc00;
4225         tx0_a = (x * oldval) >> 8;
4226
4227         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XA_TX_IQ_IMBALANCE);
4228         val32 &= ~0x3ff;
4229         val32 |= tx0_a;
4230         rtl8xxxu_write32(priv, REG_OFDM0_XA_TX_IQ_IMBALANCE, val32);
4231
4232         val32 = rtl8xxxu_read32(priv, REG_OFDM0_ENERGY_CCA_THRES);
4233         val32 &= ~BIT(31);
4234         if ((x * oldval >> 7) & 0x1)
4235                 val32 |= BIT(31);
4236         rtl8xxxu_write32(priv, REG_OFDM0_ENERGY_CCA_THRES, val32);
4237
4238         y = result[candidate][1];
4239         if ((y & 0x00000200) != 0)
4240                 y = y | 0xfffffc00;
4241         tx0_c = (y * oldval) >> 8;
4242
4243         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XC_TX_AFE);
4244         val32 &= ~0xf0000000;
4245         val32 |= (((tx0_c & 0x3c0) >> 6) << 28);
4246         rtl8xxxu_write32(priv, REG_OFDM0_XC_TX_AFE, val32);
4247
4248         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XA_TX_IQ_IMBALANCE);
4249         val32 &= ~0x003f0000;
4250         val32 |= ((tx0_c & 0x3f) << 16);
4251         rtl8xxxu_write32(priv, REG_OFDM0_XA_TX_IQ_IMBALANCE, val32);
4252
4253         val32 = rtl8xxxu_read32(priv, REG_OFDM0_ENERGY_CCA_THRES);
4254         val32 &= ~BIT(29);
4255         if ((y * oldval >> 7) & 0x1)
4256                 val32 |= BIT(29);
4257         rtl8xxxu_write32(priv, REG_OFDM0_ENERGY_CCA_THRES, val32);
4258
4259         if (tx_only) {
4260                 dev_dbg(&priv->udev->dev, "%s: only TX\n", __func__);
4261                 return;
4262         }
4263
4264         reg = result[candidate][2];
4265
4266         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XA_RX_IQ_IMBALANCE);
4267         val32 &= ~0x3ff;
4268         val32 |= (reg & 0x3ff);
4269         rtl8xxxu_write32(priv, REG_OFDM0_XA_RX_IQ_IMBALANCE, val32);
4270
4271         reg = result[candidate][3] & 0x3F;
4272
4273         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XA_RX_IQ_IMBALANCE);
4274         val32 &= ~0xfc00;
4275         val32 |= ((reg << 10) & 0xfc00);
4276         rtl8xxxu_write32(priv, REG_OFDM0_XA_RX_IQ_IMBALANCE, val32);
4277
4278         reg = (result[candidate][3] >> 6) & 0xF;
4279
4280         val32 = rtl8xxxu_read32(priv, REG_OFDM0_RX_IQ_EXT_ANTA);
4281         val32 &= ~0xf0000000;
4282         val32 |= (reg << 28);
4283         rtl8xxxu_write32(priv, REG_OFDM0_RX_IQ_EXT_ANTA, val32);
4284 }
4285
4286 static void rtl8xxxu_fill_iqk_matrix_b(struct rtl8xxxu_priv *priv,
4287                                        bool iqk_ok, int result[][8],
4288                                        int candidate, bool tx_only)
4289 {
4290         u32 oldval, x, tx1_a, reg;
4291         int y, tx1_c;
4292         u32 val32;
4293
4294         if (!iqk_ok)
4295                 return;
4296
4297         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XB_TX_IQ_IMBALANCE);
4298         oldval = val32 >> 22;
4299
4300         x = result[candidate][4];
4301         if ((x & 0x00000200) != 0)
4302                 x = x | 0xfffffc00;
4303         tx1_a = (x * oldval) >> 8;
4304
4305         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XB_TX_IQ_IMBALANCE);
4306         val32 &= ~0x3ff;
4307         val32 |= tx1_a;
4308         rtl8xxxu_write32(priv, REG_OFDM0_XB_TX_IQ_IMBALANCE, val32);
4309
4310         val32 = rtl8xxxu_read32(priv, REG_OFDM0_ENERGY_CCA_THRES);
4311         val32 &= ~BIT(27);
4312         if ((x * oldval >> 7) & 0x1)
4313                 val32 |= BIT(27);
4314         rtl8xxxu_write32(priv, REG_OFDM0_ENERGY_CCA_THRES, val32);
4315
4316         y = result[candidate][5];
4317         if ((y & 0x00000200) != 0)
4318                 y = y | 0xfffffc00;
4319         tx1_c = (y * oldval) >> 8;
4320
4321         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XD_TX_AFE);
4322         val32 &= ~0xf0000000;
4323         val32 |= (((tx1_c & 0x3c0) >> 6) << 28);
4324         rtl8xxxu_write32(priv, REG_OFDM0_XD_TX_AFE, val32);
4325
4326         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XB_TX_IQ_IMBALANCE);
4327         val32 &= ~0x003f0000;
4328         val32 |= ((tx1_c & 0x3f) << 16);
4329         rtl8xxxu_write32(priv, REG_OFDM0_XB_TX_IQ_IMBALANCE, val32);
4330
4331         val32 = rtl8xxxu_read32(priv, REG_OFDM0_ENERGY_CCA_THRES);
4332         val32 &= ~BIT(25);
4333         if ((y * oldval >> 7) & 0x1)
4334                 val32 |= BIT(25);
4335         rtl8xxxu_write32(priv, REG_OFDM0_ENERGY_CCA_THRES, val32);
4336
4337         if (tx_only) {
4338                 dev_dbg(&priv->udev->dev, "%s: only TX\n", __func__);
4339                 return;
4340         }
4341
4342         reg = result[candidate][6];
4343
4344         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XB_RX_IQ_IMBALANCE);
4345         val32 &= ~0x3ff;
4346         val32 |= (reg & 0x3ff);
4347         rtl8xxxu_write32(priv, REG_OFDM0_XB_RX_IQ_IMBALANCE, val32);
4348
4349         reg = result[candidate][7] & 0x3f;
4350
4351         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XB_RX_IQ_IMBALANCE);
4352         val32 &= ~0xfc00;
4353         val32 |= ((reg << 10) & 0xfc00);
4354         rtl8xxxu_write32(priv, REG_OFDM0_XB_RX_IQ_IMBALANCE, val32);
4355
4356         reg = (result[candidate][7] >> 6) & 0xf;
4357
4358         val32 = rtl8xxxu_read32(priv, REG_OFDM0_AGCR_SSI_TABLE);
4359         val32 &= ~0x0000f000;
4360         val32 |= (reg << 12);
4361         rtl8xxxu_write32(priv, REG_OFDM0_AGCR_SSI_TABLE, val32);
4362 }
4363
4364 #define MAX_TOLERANCE           5
4365
4366 static bool rtl8xxxu_simularity_compare(struct rtl8xxxu_priv *priv,
4367                                         int result[][8], int c1, int c2)
4368 {
4369         u32 i, j, diff, simubitmap, bound = 0;
4370         int candidate[2] = {-1, -1};    /* for path A and path B */
4371         bool retval = true;
4372
4373         if (priv->tx_paths > 1)
4374                 bound = 8;
4375         else
4376                 bound = 4;
4377
4378         simubitmap = 0;
4379
4380         for (i = 0; i < bound; i++) {
4381                 diff = (result[c1][i] > result[c2][i]) ?
4382                         (result[c1][i] - result[c2][i]) :
4383                         (result[c2][i] - result[c1][i]);
4384                 if (diff > MAX_TOLERANCE) {
4385                         if ((i == 2 || i == 6) && !simubitmap) {
4386                                 if (result[c1][i] + result[c1][i + 1] == 0)
4387                                         candidate[(i / 4)] = c2;
4388                                 else if (result[c2][i] + result[c2][i + 1] == 0)
4389                                         candidate[(i / 4)] = c1;
4390                                 else
4391                                         simubitmap = simubitmap | (1 << i);
4392                         } else {
4393                                 simubitmap = simubitmap | (1 << i);
4394                         }
4395                 }
4396         }
4397
4398         if (simubitmap == 0) {
4399                 for (i = 0; i < (bound / 4); i++) {
4400                         if (candidate[i] >= 0) {
4401                                 for (j = i * 4; j < (i + 1) * 4 - 2; j++)
4402                                         result[3][j] = result[candidate[i]][j];
4403                                 retval = false;
4404                         }
4405                 }
4406                 return retval;
4407         } else if (!(simubitmap & 0x0f)) {
4408                 /* path A OK */
4409                 for (i = 0; i < 4; i++)
4410                         result[3][i] = result[c1][i];
4411         } else if (!(simubitmap & 0xf0) && priv->tx_paths > 1) {
4412                 /* path B OK */
4413                 for (i = 4; i < 8; i++)
4414                         result[3][i] = result[c1][i];
4415         }
4416
4417         return false;
4418 }
4419
4420 static bool rtl8723bu_simularity_compare(struct rtl8xxxu_priv *priv,
4421                                          int result[][8], int c1, int c2)
4422 {
4423         u32 i, j, diff, simubitmap, bound = 0;
4424         int candidate[2] = {-1, -1};    /* for path A and path B */
4425         int tmp1, tmp2;
4426         bool retval = true;
4427
4428         if (priv->tx_paths > 1)
4429                 bound = 8;
4430         else
4431                 bound = 4;
4432
4433         simubitmap = 0;
4434
4435         for (i = 0; i < bound; i++) {
4436                 if (i & 1) {
4437                         if ((result[c1][i] & 0x00000200))
4438                                 tmp1 = result[c1][i] | 0xfffffc00;
4439                         else
4440                                 tmp1 = result[c1][i];
4441
4442                         if ((result[c2][i]& 0x00000200))
4443                                 tmp2 = result[c2][i] | 0xfffffc00;
4444                         else
4445                                 tmp2 = result[c2][i];
4446                 } else {
4447                         tmp1 = result[c1][i];
4448                         tmp2 = result[c2][i];
4449                 }
4450
4451                 diff = (tmp1 > tmp2) ? (tmp1 - tmp2) : (tmp2 - tmp1);
4452
4453                 if (diff > MAX_TOLERANCE) {
4454                         if ((i == 2 || i == 6) && !simubitmap) {
4455                                 if (result[c1][i] + result[c1][i + 1] == 0)
4456                                         candidate[(i / 4)] = c2;
4457                                 else if (result[c2][i] + result[c2][i + 1] == 0)
4458                                         candidate[(i / 4)] = c1;
4459                                 else
4460                                         simubitmap = simubitmap | (1 << i);
4461                         } else {
4462                                 simubitmap = simubitmap | (1 << i);
4463                         }
4464                 }
4465         }
4466
4467         if (simubitmap == 0) {
4468                 for (i = 0; i < (bound / 4); i++) {
4469                         if (candidate[i] >= 0) {
4470                                 for (j = i * 4; j < (i + 1) * 4 - 2; j++)
4471                                         result[3][j] = result[candidate[i]][j];
4472                                 retval = false;
4473                         }
4474                 }
4475                 return retval;
4476         } else {
4477                 if (!(simubitmap & 0x03)) {
4478                         /* path A TX OK */
4479                         for (i = 0; i < 2; i++)
4480                                 result[3][i] = result[c1][i];
4481                 }
4482
4483                 if (!(simubitmap & 0x0c)) {
4484                         /* path A RX OK */
4485                         for (i = 2; i < 4; i++)
4486                                 result[3][i] = result[c1][i];
4487                 }
4488
4489                 if (!(simubitmap & 0x30) && priv->tx_paths > 1) {
4490                         /* path B RX OK */
4491                         for (i = 4; i < 6; i++)
4492                                 result[3][i] = result[c1][i];
4493                 }
4494
4495                 if (!(simubitmap & 0x30) && priv->tx_paths > 1) {
4496                         /* path B RX OK */
4497                         for (i = 6; i < 8; i++)
4498                                 result[3][i] = result[c1][i];
4499                 }
4500         }
4501
4502         return false;
4503 }
4504
4505 static void
4506 rtl8xxxu_save_mac_regs(struct rtl8xxxu_priv *priv, const u32 *reg, u32 *backup)
4507 {
4508         int i;
4509
4510         for (i = 0; i < (RTL8XXXU_MAC_REGS - 1); i++)
4511                 backup[i] = rtl8xxxu_read8(priv, reg[i]);
4512
4513         backup[i] = rtl8xxxu_read32(priv, reg[i]);
4514 }
4515
4516 static void rtl8xxxu_restore_mac_regs(struct rtl8xxxu_priv *priv,
4517                                       const u32 *reg, u32 *backup)
4518 {
4519         int i;
4520
4521         for (i = 0; i < (RTL8XXXU_MAC_REGS - 1); i++)
4522                 rtl8xxxu_write8(priv, reg[i], backup[i]);
4523
4524         rtl8xxxu_write32(priv, reg[i], backup[i]);
4525 }
4526
4527 static void rtl8xxxu_save_regs(struct rtl8xxxu_priv *priv, const u32 *regs,
4528                                u32 *backup, int count)
4529 {
4530         int i;
4531
4532         for (i = 0; i < count; i++)
4533                 backup[i] = rtl8xxxu_read32(priv, regs[i]);
4534 }
4535
4536 static void rtl8xxxu_restore_regs(struct rtl8xxxu_priv *priv, const u32 *regs,
4537                                   u32 *backup, int count)
4538 {
4539         int i;
4540
4541         for (i = 0; i < count; i++)
4542                 rtl8xxxu_write32(priv, regs[i], backup[i]);
4543 }
4544
4545
4546 static void rtl8xxxu_path_adda_on(struct rtl8xxxu_priv *priv, const u32 *regs,
4547                                   bool path_a_on)
4548 {
4549         u32 path_on;
4550         int i;
4551
4552         if (priv->tx_paths == 1) {
4553                 path_on = priv->fops->adda_1t_path_on;
4554                 rtl8xxxu_write32(priv, regs[0], priv->fops->adda_1t_init);
4555         } else {
4556                 path_on = path_a_on ? priv->fops->adda_2t_path_on_a :
4557                         priv->fops->adda_2t_path_on_b;
4558
4559                 rtl8xxxu_write32(priv, regs[0], path_on);
4560         }
4561
4562         for (i = 1 ; i < RTL8XXXU_ADDA_REGS ; i++)
4563                 rtl8xxxu_write32(priv, regs[i], path_on);
4564 }
4565
4566 static void rtl8xxxu_mac_calibration(struct rtl8xxxu_priv *priv,
4567                                      const u32 *regs, u32 *backup)
4568 {
4569         int i = 0;
4570
4571         rtl8xxxu_write8(priv, regs[i], 0x3f);
4572
4573         for (i = 1 ; i < (RTL8XXXU_MAC_REGS - 1); i++)
4574                 rtl8xxxu_write8(priv, regs[i], (u8)(backup[i] & ~BIT(3)));
4575
4576         rtl8xxxu_write8(priv, regs[i], (u8)(backup[i] & ~BIT(5)));
4577 }
4578
4579 static int rtl8xxxu_iqk_path_a(struct rtl8xxxu_priv *priv)
4580 {
4581         u32 reg_eac, reg_e94, reg_e9c, reg_ea4, val32;
4582         int result = 0;
4583
4584         /* path-A IQK setting */
4585         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x10008c1f);
4586         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x10008c1f);
4587         rtl8xxxu_write32(priv, REG_TX_IQK_PI_A, 0x82140102);
4588
4589         val32 = (priv->rf_paths > 1) ? 0x28160202 :
4590                 /*IS_81xxC_VENDOR_UMC_B_CUT(pHalData->VersionID)?0x28160202: */
4591                 0x28160502;
4592         rtl8xxxu_write32(priv, REG_RX_IQK_PI_A, val32);
4593
4594         /* path-B IQK setting */
4595         if (priv->rf_paths > 1) {
4596                 rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x10008c22);
4597                 rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x10008c22);
4598                 rtl8xxxu_write32(priv, REG_TX_IQK_PI_B, 0x82140102);
4599                 rtl8xxxu_write32(priv, REG_RX_IQK_PI_B, 0x28160202);
4600         }
4601
4602         /* LO calibration setting */
4603         rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x001028d1);
4604
4605         /* One shot, path A LOK & IQK */
4606         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf9000000);
4607         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8000000);
4608
4609         mdelay(1);
4610
4611         /* Check failed */
4612         reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
4613         reg_e94 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_A);
4614         reg_e9c = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_A);
4615         reg_ea4 = rtl8xxxu_read32(priv, REG_RX_POWER_BEFORE_IQK_A_2);
4616
4617         if (!(reg_eac & BIT(28)) &&
4618             ((reg_e94 & 0x03ff0000) != 0x01420000) &&
4619             ((reg_e9c & 0x03ff0000) != 0x00420000))
4620                 result |= 0x01;
4621         else    /* If TX not OK, ignore RX */
4622                 goto out;
4623
4624         /* If TX is OK, check whether RX is OK */
4625         if (!(reg_eac & BIT(27)) &&
4626             ((reg_ea4 & 0x03ff0000) != 0x01320000) &&
4627             ((reg_eac & 0x03ff0000) != 0x00360000))
4628                 result |= 0x02;
4629         else
4630                 dev_warn(&priv->udev->dev, "%s: Path A RX IQK failed!\n",
4631                          __func__);
4632 out:
4633         return result;
4634 }
4635
4636 static int rtl8xxxu_iqk_path_b(struct rtl8xxxu_priv *priv)
4637 {
4638         u32 reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc;
4639         int result = 0;
4640
4641         /* One shot, path B LOK & IQK */
4642         rtl8xxxu_write32(priv, REG_IQK_AGC_CONT, 0x00000002);
4643         rtl8xxxu_write32(priv, REG_IQK_AGC_CONT, 0x00000000);
4644
4645         mdelay(1);
4646
4647         /* Check failed */
4648         reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
4649         reg_eb4 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_B);
4650         reg_ebc = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_B);
4651         reg_ec4 = rtl8xxxu_read32(priv, REG_RX_POWER_BEFORE_IQK_B_2);
4652         reg_ecc = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_B_2);
4653
4654         if (!(reg_eac & BIT(31)) &&
4655             ((reg_eb4 & 0x03ff0000) != 0x01420000) &&
4656             ((reg_ebc & 0x03ff0000) != 0x00420000))
4657                 result |= 0x01;
4658         else
4659                 goto out;
4660
4661         if (!(reg_eac & BIT(30)) &&
4662             (((reg_ec4 & 0x03ff0000) >> 16) != 0x132) &&
4663             (((reg_ecc & 0x03ff0000) >> 16) != 0x36))
4664                 result |= 0x02;
4665         else
4666                 dev_warn(&priv->udev->dev, "%s: Path B RX IQK failed!\n",
4667                          __func__);
4668 out:
4669         return result;
4670 }
4671
4672 static int rtl8723bu_iqk_path_a(struct rtl8xxxu_priv *priv)
4673 {
4674         u32 reg_eac, reg_e94, reg_e9c, path_sel, val32;
4675         int result = 0;
4676
4677         path_sel = rtl8xxxu_read32(priv, REG_S0S1_PATH_SWITCH);
4678
4679         /*
4680          * Leave IQK mode
4681          */
4682         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
4683         val32 &= 0x000000ff;
4684         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
4685
4686         /*
4687          * Enable path A PA in TX IQK mode
4688          */
4689         val32 = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_WE_LUT);
4690         val32 |= 0x80000;
4691         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_WE_LUT, val32);
4692         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_RCK_OS, 0x20000);
4693         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G1, 0x0003f);
4694         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G2, 0xc7f87);
4695
4696         /*
4697          * Tx IQK setting
4698          */
4699         rtl8xxxu_write32(priv, REG_TX_IQK, 0x01007c00);
4700         rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
4701
4702         /* path-A IQK setting */
4703         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x18008c1c);
4704         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x38008c1c);
4705         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x38008c1c);
4706         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
4707
4708         rtl8xxxu_write32(priv, REG_TX_IQK_PI_A, 0x821403ea);
4709         rtl8xxxu_write32(priv, REG_RX_IQK_PI_A, 0x28110000);
4710         rtl8xxxu_write32(priv, REG_TX_IQK_PI_B, 0x82110000);
4711         rtl8xxxu_write32(priv, REG_RX_IQK_PI_B, 0x28110000);
4712
4713         /* LO calibration setting */
4714         rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x00462911);
4715
4716         /*
4717          * Enter IQK mode
4718          */
4719         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
4720         val32 &= 0x000000ff;
4721         val32 |= 0x80800000;
4722         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
4723
4724         /*
4725          * The vendor driver indicates the USB module is always using
4726          * S0S1 path 1 for the 8723bu. This may be different for 8192eu
4727          */
4728         if (priv->rf_paths > 1)
4729                 rtl8xxxu_write32(priv, REG_S0S1_PATH_SWITCH, 0x00000000);
4730         else
4731                 rtl8xxxu_write32(priv, REG_S0S1_PATH_SWITCH, 0x00000280);
4732
4733         /*
4734          * Bit 12 seems to be BT_GRANT, and is only found in the 8723bu.
4735          * No trace of this in the 8192eu or 8188eu vendor drivers.
4736          */
4737         rtl8xxxu_write32(priv, REG_BT_CONTROL_8723BU, 0x00000800);
4738
4739         /* One shot, path A LOK & IQK */
4740         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf9000000);
4741         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8000000);
4742
4743         mdelay(1);
4744
4745         /* Restore Ant Path */
4746         rtl8xxxu_write32(priv, REG_S0S1_PATH_SWITCH, path_sel);
4747 #ifdef RTL8723BU_BT
4748         /* GNT_BT = 1 */
4749         rtl8xxxu_write32(priv, REG_BT_CONTROL_8723BU, 0x00001800);
4750 #endif
4751
4752         /*
4753          * Leave IQK mode
4754          */
4755         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
4756         val32 &= 0x000000ff;
4757         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
4758
4759         /* Check failed */
4760         reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
4761         reg_e94 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_A);
4762         reg_e9c = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_A);
4763
4764         val32 = (reg_e9c >> 16) & 0x3ff;
4765         if (val32 & 0x200)
4766                 val32 = 0x400 - val32;
4767
4768         if (!(reg_eac & BIT(28)) &&
4769             ((reg_e94 & 0x03ff0000) != 0x01420000) &&
4770             ((reg_e9c & 0x03ff0000) != 0x00420000) &&
4771             ((reg_e94 & 0x03ff0000)  < 0x01100000) &&
4772             ((reg_e94 & 0x03ff0000)  > 0x00f00000) &&
4773             val32 < 0xf)
4774                 result |= 0x01;
4775         else    /* If TX not OK, ignore RX */
4776                 goto out;
4777
4778 out:
4779         return result;
4780 }
4781
4782 static int rtl8723bu_rx_iqk_path_a(struct rtl8xxxu_priv *priv)
4783 {
4784         u32 reg_ea4, reg_eac, reg_e94, reg_e9c, path_sel, val32;
4785         int result = 0;
4786
4787         path_sel = rtl8xxxu_read32(priv, REG_S0S1_PATH_SWITCH);
4788
4789         /*
4790          * Leave IQK mode
4791          */
4792         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
4793         val32 &= 0x000000ff;
4794         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
4795
4796         /*
4797          * Enable path A PA in TX IQK mode
4798          */
4799         val32 = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_WE_LUT);
4800         val32 |= 0x80000;
4801         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_WE_LUT, val32);
4802         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_RCK_OS, 0x30000);
4803         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G1, 0x0001f);
4804         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G2, 0xf7fb7);
4805
4806         /*
4807          * Tx IQK setting
4808          */
4809         rtl8xxxu_write32(priv, REG_TX_IQK, 0x01007c00);
4810         rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
4811
4812         /* path-A IQK setting */
4813         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x18008c1c);
4814         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x38008c1c);
4815         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x38008c1c);
4816         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
4817
4818         rtl8xxxu_write32(priv, REG_TX_IQK_PI_A, 0x82160ff0);
4819         rtl8xxxu_write32(priv, REG_RX_IQK_PI_A, 0x28110000);
4820         rtl8xxxu_write32(priv, REG_TX_IQK_PI_B, 0x82110000);
4821         rtl8xxxu_write32(priv, REG_RX_IQK_PI_B, 0x28110000);
4822
4823         /* LO calibration setting */
4824         rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x0046a911);
4825
4826         /*
4827          * Enter IQK mode
4828          */
4829         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
4830         val32 &= 0x000000ff;
4831         val32 |= 0x80800000;
4832         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
4833
4834         /*
4835          * The vendor driver indicates the USB module is always using
4836          * S0S1 path 1 for the 8723bu. This may be different for 8192eu
4837          */
4838         if (priv->rf_paths > 1)
4839                 rtl8xxxu_write32(priv, REG_S0S1_PATH_SWITCH, 0x00000000);
4840         else
4841                 rtl8xxxu_write32(priv, REG_S0S1_PATH_SWITCH, 0x00000280);
4842
4843         /*
4844          * Bit 12 seems to be BT_GRANT, and is only found in the 8723bu.
4845          * No trace of this in the 8192eu or 8188eu vendor drivers.
4846          */
4847         rtl8xxxu_write32(priv, REG_BT_CONTROL_8723BU, 0x00000800);
4848
4849         /* One shot, path A LOK & IQK */
4850         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf9000000);
4851         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8000000);
4852
4853         mdelay(1);
4854
4855         /* Restore Ant Path */
4856         rtl8xxxu_write32(priv, REG_S0S1_PATH_SWITCH, path_sel);
4857 #ifdef RTL8723BU_BT
4858         /* GNT_BT = 1 */
4859         rtl8xxxu_write32(priv, REG_BT_CONTROL_8723BU, 0x00001800);
4860 #endif
4861
4862         /*
4863          * Leave IQK mode
4864          */
4865         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
4866         val32 &= 0x000000ff;
4867         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
4868
4869         /* Check failed */
4870         reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
4871         reg_e94 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_A);
4872         reg_e9c = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_A);
4873
4874         val32 = (reg_e9c >> 16) & 0x3ff;
4875         if (val32 & 0x200)
4876                 val32 = 0x400 - val32;
4877
4878         if (!(reg_eac & BIT(28)) &&
4879             ((reg_e94 & 0x03ff0000) != 0x01420000) &&
4880             ((reg_e9c & 0x03ff0000) != 0x00420000) &&
4881             ((reg_e94 & 0x03ff0000)  < 0x01100000) &&
4882             ((reg_e94 & 0x03ff0000)  > 0x00f00000) &&
4883             val32 < 0xf)
4884                 result |= 0x01;
4885         else    /* If TX not OK, ignore RX */
4886                 goto out;
4887
4888         val32 = 0x80007c00 | (reg_e94 &0x3ff0000) |
4889                 ((reg_e9c & 0x3ff0000) >> 16);
4890         rtl8xxxu_write32(priv, REG_TX_IQK, val32);
4891
4892         /*
4893          * Modify RX IQK mode
4894          */
4895         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
4896         val32 &= 0x000000ff;
4897         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
4898         val32 = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_WE_LUT);
4899         val32 |= 0x80000;
4900         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_WE_LUT, val32);
4901         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_RCK_OS, 0x30000);
4902         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G1, 0x0001f);
4903         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G2, 0xf7d77);
4904
4905         /*
4906          * PA, PAD setting
4907          */
4908         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_DF, 0xf80);
4909         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_55, 0x4021f);
4910
4911         /*
4912          * RX IQK setting
4913          */
4914         rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
4915
4916         /* path-A IQK setting */
4917         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x38008c1c);
4918         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x18008c1c);
4919         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x38008c1c);
4920         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
4921
4922         rtl8xxxu_write32(priv, REG_TX_IQK_PI_A, 0x82110000);
4923         rtl8xxxu_write32(priv, REG_RX_IQK_PI_A, 0x2816001f);
4924         rtl8xxxu_write32(priv, REG_TX_IQK_PI_B, 0x82110000);
4925         rtl8xxxu_write32(priv, REG_RX_IQK_PI_B, 0x28110000);
4926
4927         /* LO calibration setting */
4928         rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x0046a8d1);
4929
4930         /*
4931          * Enter IQK mode
4932          */
4933         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
4934         val32 &= 0x000000ff;
4935         val32 |= 0x80800000;
4936         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
4937
4938         if (priv->rf_paths > 1)
4939                 rtl8xxxu_write32(priv, REG_S0S1_PATH_SWITCH, 0x00000000);
4940         else
4941                 rtl8xxxu_write32(priv, REG_S0S1_PATH_SWITCH, 0x00000280);
4942
4943         /*
4944          * Disable BT
4945          */
4946         rtl8xxxu_write32(priv, REG_BT_CONTROL_8723BU, 0x00000800);
4947
4948         /* One shot, path A LOK & IQK */
4949         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf9000000);
4950         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8000000);
4951
4952         mdelay(1);
4953
4954         /* Restore Ant Path */
4955         rtl8xxxu_write32(priv, REG_S0S1_PATH_SWITCH, path_sel);
4956 #ifdef RTL8723BU_BT
4957         /* GNT_BT = 1 */
4958         rtl8xxxu_write32(priv, REG_BT_CONTROL_8723BU, 0x00001800);
4959 #endif
4960
4961         /*
4962          * Leave IQK mode
4963          */
4964         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
4965         val32 &= 0x000000ff;
4966         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
4967
4968         /* Check failed */
4969         reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
4970         reg_ea4 = rtl8xxxu_read32(priv, REG_RX_POWER_BEFORE_IQK_A_2);
4971
4972         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_DF, 0x780);
4973
4974         val32 = (reg_eac >> 16) & 0x3ff;
4975         if (val32 & 0x200)
4976                 val32 = 0x400 - val32;
4977
4978         if (!(reg_eac & BIT(27)) &&
4979             ((reg_ea4 & 0x03ff0000) != 0x01320000) &&
4980             ((reg_eac & 0x03ff0000) != 0x00360000) &&
4981             ((reg_ea4 & 0x03ff0000)  < 0x01100000) &&
4982             ((reg_ea4 & 0x03ff0000)  > 0x00f00000) &&
4983             val32 < 0xf)
4984                 result |= 0x02;
4985         else    /* If TX not OK, ignore RX */
4986                 goto out;
4987 out:
4988         return result;
4989 }
4990
4991 #ifdef RTL8723BU_PATH_B
4992 static int rtl8723bu_iqk_path_b(struct rtl8xxxu_priv *priv)
4993 {
4994         u32 reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc, path_sel;
4995         int result = 0;
4996
4997         path_sel = rtl8xxxu_read32(priv, REG_S0S1_PATH_SWITCH);
4998
4999         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
5000         val32 &= 0x000000ff;
5001         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
5002
5003         /* One shot, path B LOK & IQK */
5004         rtl8xxxu_write32(priv, REG_IQK_AGC_CONT, 0x00000002);
5005         rtl8xxxu_write32(priv, REG_IQK_AGC_CONT, 0x00000000);
5006
5007         mdelay(1);
5008
5009         /* Check failed */
5010         reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
5011         reg_eb4 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_B);
5012         reg_ebc = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_B);
5013         reg_ec4 = rtl8xxxu_read32(priv, REG_RX_POWER_BEFORE_IQK_B_2);
5014         reg_ecc = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_B_2);
5015
5016         if (!(reg_eac & BIT(31)) &&
5017             ((reg_eb4 & 0x03ff0000) != 0x01420000) &&
5018             ((reg_ebc & 0x03ff0000) != 0x00420000))
5019                 result |= 0x01;
5020         else
5021                 goto out;
5022
5023         if (!(reg_eac & BIT(30)) &&
5024             (((reg_ec4 & 0x03ff0000) >> 16) != 0x132) &&
5025             (((reg_ecc & 0x03ff0000) >> 16) != 0x36))
5026                 result |= 0x02;
5027         else
5028                 dev_warn(&priv->udev->dev, "%s: Path B RX IQK failed!\n",
5029                          __func__);
5030 out:
5031         return result;
5032 }
5033 #endif
5034
5035 static int rtl8192eu_iqk_path_a(struct rtl8xxxu_priv *priv)
5036 {
5037         u32 reg_eac, reg_e94, reg_e9c;
5038         int result = 0;
5039
5040         /*
5041          * TX IQK
5042          * PA/PAD controlled by 0x0
5043          */
5044         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00000000);
5045         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_DF, 0x00180);
5046         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x80800000);
5047
5048         /* Path A IQK setting */
5049         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x18008c1c);
5050         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x38008c1c);
5051         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x38008c1c);
5052         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
5053
5054         rtl8xxxu_write32(priv, REG_TX_IQK_PI_A, 0x82140303);
5055         rtl8xxxu_write32(priv, REG_RX_IQK_PI_A, 0x68160000);
5056
5057         /* LO calibration setting */
5058         rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x00462911);
5059
5060         /* One shot, path A LOK & IQK */
5061         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf9000000);
5062         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8000000);
5063
5064         mdelay(10);
5065
5066         /* Check failed */
5067         reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
5068         reg_e94 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_A);
5069         reg_e9c = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_A);
5070
5071         if (!(reg_eac & BIT(28)) &&
5072             ((reg_e94 & 0x03ff0000) != 0x01420000) &&
5073             ((reg_e9c & 0x03ff0000) != 0x00420000))
5074                 result |= 0x01;
5075
5076         return result;
5077 }
5078
5079 static int rtl8192eu_rx_iqk_path_a(struct rtl8xxxu_priv *priv)
5080 {
5081         u32 reg_ea4, reg_eac, reg_e94, reg_e9c, val32;
5082         int result = 0;
5083
5084         /* Leave IQK mode */
5085         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00);
5086
5087         /* Enable path A PA in TX IQK mode */
5088         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_WE_LUT, 0x800a0);
5089         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_RCK_OS, 0x30000);
5090         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G1, 0x0000f);
5091         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G2, 0xf117b);
5092
5093         /* PA/PAD control by 0x56, and set = 0x0 */
5094         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_DF, 0x00980);
5095         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_56, 0x51000);
5096
5097         /* Enter IQK mode */
5098         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x80800000);
5099
5100         /* TX IQK setting */
5101         rtl8xxxu_write32(priv, REG_TX_IQK, 0x01007c00);
5102         rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
5103
5104         /* path-A IQK setting */
5105         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x18008c1c);
5106         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x38008c1c);
5107         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x38008c1c);
5108         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
5109
5110         rtl8xxxu_write32(priv, REG_TX_IQK_PI_A, 0x82160c1f);
5111         rtl8xxxu_write32(priv, REG_RX_IQK_PI_A, 0x68160c1f);
5112
5113         /* LO calibration setting */
5114         rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x0046a911);
5115
5116         /* One shot, path A LOK & IQK */
5117         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xfa000000);
5118         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8000000);
5119
5120         mdelay(10);
5121
5122         /* Check failed */
5123         reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
5124         reg_e94 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_A);
5125         reg_e9c = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_A);
5126
5127         if (!(reg_eac & BIT(28)) &&
5128             ((reg_e94 & 0x03ff0000) != 0x01420000) &&
5129             ((reg_e9c & 0x03ff0000) != 0x00420000)) {
5130                 result |= 0x01;
5131         } else {
5132                 /* PA/PAD controlled by 0x0 */
5133                 rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00000000);
5134                 rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_DF, 0x180);
5135                 goto out;
5136         }
5137
5138         val32 = 0x80007c00 |
5139                 (reg_e94 & 0x03ff0000) | ((reg_e9c >> 16) & 0x03ff);
5140         rtl8xxxu_write32(priv, REG_TX_IQK, val32);
5141
5142         /* Modify RX IQK mode table */
5143         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00000000);
5144
5145         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_WE_LUT, 0x800a0);
5146         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_RCK_OS, 0x30000);
5147         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G1, 0x0000f);
5148         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G2, 0xf7ffa);
5149
5150         /* PA/PAD control by 0x56, and set = 0x0 */
5151         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_DF, 0x00980);
5152         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_56, 0x51000);
5153
5154         /* Enter IQK mode */
5155         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x80800000);
5156
5157         /* IQK setting */
5158         rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
5159
5160         /* Path A IQK setting */
5161         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x38008c1c);
5162         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x18008c1c);
5163         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x38008c1c);
5164         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
5165
5166         rtl8xxxu_write32(priv, REG_TX_IQK_PI_A, 0x82160c1f);
5167         rtl8xxxu_write32(priv, REG_RX_IQK_PI_A, 0x28160c1f);
5168
5169         /* LO calibration setting */
5170         rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x0046a891);
5171
5172         /* One shot, path A LOK & IQK */
5173         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xfa000000);
5174         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8000000);
5175
5176         mdelay(10);
5177
5178         reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
5179         reg_ea4 = rtl8xxxu_read32(priv, REG_RX_POWER_BEFORE_IQK_A_2);
5180
5181         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00000000);
5182         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_DF, 0x180);
5183
5184         if (!(reg_eac & BIT(27)) &&
5185             ((reg_ea4 & 0x03ff0000) != 0x01320000) &&
5186             ((reg_eac & 0x03ff0000) != 0x00360000))
5187                 result |= 0x02;
5188         else
5189                 dev_warn(&priv->udev->dev, "%s: Path A RX IQK failed!\n",
5190                          __func__);
5191
5192 out:
5193         return result;
5194 }
5195
5196 static int rtl8192eu_iqk_path_b(struct rtl8xxxu_priv *priv)
5197 {
5198         u32 reg_eac, reg_eb4, reg_ebc;
5199         int result = 0;
5200
5201         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00000000);
5202         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_UNKNOWN_DF, 0x00180);
5203         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x80800000);
5204
5205         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00000000);
5206         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x80800000);
5207
5208         /* Path B IQK setting */
5209         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x38008c1c);
5210         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x38008c1c);
5211         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x18008c1c);
5212         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
5213
5214         rtl8xxxu_write32(priv, REG_TX_IQK_PI_B, 0x821403e2);
5215         rtl8xxxu_write32(priv, REG_RX_IQK_PI_B, 0x68160000);
5216
5217         /* LO calibration setting */
5218         rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x00492911);
5219
5220         /* One shot, path A LOK & IQK */
5221         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xfa000000);
5222         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8000000);
5223
5224         mdelay(1);
5225
5226         /* Check failed */
5227         reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
5228         reg_eb4 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_B);
5229         reg_ebc = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_B);
5230
5231         if (!(reg_eac & BIT(31)) &&
5232             ((reg_eb4 & 0x03ff0000) != 0x01420000) &&
5233             ((reg_ebc & 0x03ff0000) != 0x00420000))
5234                 result |= 0x01;
5235         else
5236                 dev_warn(&priv->udev->dev, "%s: Path B IQK failed!\n",
5237                          __func__);
5238
5239         return result;
5240 }
5241
5242 static int rtl8192eu_rx_iqk_path_b(struct rtl8xxxu_priv *priv)
5243 {
5244         u32 reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc, val32;
5245         int result = 0;
5246
5247         /* Leave IQK mode */
5248         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00000000);
5249
5250         /* Enable path A PA in TX IQK mode */
5251         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_WE_LUT, 0x800a0);
5252         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_RCK_OS, 0x30000);
5253         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_TXPA_G1, 0x0000f);
5254         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_TXPA_G2, 0xf117b);
5255
5256         /* PA/PAD control by 0x56, and set = 0x0 */
5257         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_UNKNOWN_DF, 0x00980);
5258         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_UNKNOWN_56, 0x51000);
5259
5260         /* Enter IQK mode */
5261         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x80800000);
5262
5263         /* TX IQK setting */
5264         rtl8xxxu_write32(priv, REG_TX_IQK, 0x01007c00);
5265         rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
5266
5267         /* path-A IQK setting */
5268         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x38008c1c);
5269         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x38008c1c);
5270         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x18008c1c);
5271         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
5272
5273         rtl8xxxu_write32(priv, REG_TX_IQK_PI_B, 0x82160c1f);
5274         rtl8xxxu_write32(priv, REG_RX_IQK_PI_B, 0x68160c1f);
5275
5276         /* LO calibration setting */
5277         rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x0046a911);
5278
5279         /* One shot, path A LOK & IQK */
5280         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xfa000000);
5281         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8000000);
5282
5283         mdelay(10);
5284
5285         /* Check failed */
5286         reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
5287         reg_eb4 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_B);
5288         reg_ebc = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_B);
5289
5290         if (!(reg_eac & BIT(31)) &&
5291             ((reg_eb4 & 0x03ff0000) != 0x01420000) &&
5292             ((reg_ebc & 0x03ff0000) != 0x00420000)) {
5293                 result |= 0x01;
5294         } else {
5295                 /*
5296                  * PA/PAD controlled by 0x0
5297                  * Vendor driver restores RF_A here which I believe is a bug
5298                  */
5299                 rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00000000);
5300                 rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_UNKNOWN_DF, 0x180);
5301                 goto out;
5302         }
5303
5304         val32 = 0x80007c00 |
5305                 (reg_eb4 & 0x03ff0000) | ((reg_ebc >> 16) & 0x03ff);
5306         rtl8xxxu_write32(priv, REG_TX_IQK, val32);
5307
5308         /* Modify RX IQK mode table */
5309         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00000000);
5310
5311         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_WE_LUT, 0x800a0);
5312         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_RCK_OS, 0x30000);
5313         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_TXPA_G1, 0x0000f);
5314         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_TXPA_G2, 0xf7ffa);
5315
5316         /* PA/PAD control by 0x56, and set = 0x0 */
5317         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_UNKNOWN_DF, 0x00980);
5318         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_UNKNOWN_56, 0x51000);
5319
5320         /* Enter IQK mode */
5321         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x80800000);
5322
5323         /* IQK setting */
5324         rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
5325
5326         /* Path A IQK setting */
5327         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x38008c1c);
5328         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x38008c1c);
5329         rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x38008c1c);
5330         rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x18008c1c);
5331
5332         rtl8xxxu_write32(priv, REG_TX_IQK_PI_A, 0x82160c1f);
5333         rtl8xxxu_write32(priv, REG_RX_IQK_PI_A, 0x28160c1f);
5334
5335         /* LO calibration setting */
5336         rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x0046a891);
5337
5338         /* One shot, path A LOK & IQK */
5339         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xfa000000);
5340         rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8000000);
5341
5342         mdelay(10);
5343
5344         reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
5345         reg_ec4 = rtl8xxxu_read32(priv, REG_RX_POWER_BEFORE_IQK_B_2);
5346         reg_ecc = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_B_2);
5347
5348         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00000000);
5349         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_UNKNOWN_DF, 0x180);
5350
5351         if (!(reg_eac & BIT(30)) &&
5352             ((reg_ec4 & 0x03ff0000) != 0x01320000) &&
5353             ((reg_ecc & 0x03ff0000) != 0x00360000))
5354                 result |= 0x02;
5355         else
5356                 dev_warn(&priv->udev->dev, "%s: Path B RX IQK failed!\n",
5357                          __func__);
5358
5359 out:
5360         return result;
5361 }
5362
5363 static void rtl8xxxu_phy_iqcalibrate(struct rtl8xxxu_priv *priv,
5364                                      int result[][8], int t)
5365 {
5366         struct device *dev = &priv->udev->dev;
5367         u32 i, val32;
5368         int path_a_ok, path_b_ok;
5369         int retry = 2;
5370         const u32 adda_regs[RTL8XXXU_ADDA_REGS] = {
5371                 REG_FPGA0_XCD_SWITCH_CTRL, REG_BLUETOOTH,
5372                 REG_RX_WAIT_CCA, REG_TX_CCK_RFON,
5373                 REG_TX_CCK_BBON, REG_TX_OFDM_RFON,
5374                 REG_TX_OFDM_BBON, REG_TX_TO_RX,
5375                 REG_TX_TO_TX, REG_RX_CCK,
5376                 REG_RX_OFDM, REG_RX_WAIT_RIFS,
5377                 REG_RX_TO_RX, REG_STANDBY,
5378                 REG_SLEEP, REG_PMPD_ANAEN
5379         };
5380         const u32 iqk_mac_regs[RTL8XXXU_MAC_REGS] = {
5381                 REG_TXPAUSE, REG_BEACON_CTRL,
5382                 REG_BEACON_CTRL_1, REG_GPIO_MUXCFG
5383         };
5384         const u32 iqk_bb_regs[RTL8XXXU_BB_REGS] = {
5385                 REG_OFDM0_TRX_PATH_ENABLE, REG_OFDM0_TR_MUX_PAR,
5386                 REG_FPGA0_XCD_RF_SW_CTRL, REG_CONFIG_ANT_A, REG_CONFIG_ANT_B,
5387                 REG_FPGA0_XAB_RF_SW_CTRL, REG_FPGA0_XA_RF_INT_OE,
5388                 REG_FPGA0_XB_RF_INT_OE, REG_FPGA0_RF_MODE
5389         };
5390
5391         /*
5392          * Note: IQ calibration must be performed after loading
5393          *       PHY_REG.txt , and radio_a, radio_b.txt
5394          */
5395
5396         if (t == 0) {
5397                 /* Save ADDA parameters, turn Path A ADDA on */
5398                 rtl8xxxu_save_regs(priv, adda_regs, priv->adda_backup,
5399                                    RTL8XXXU_ADDA_REGS);
5400                 rtl8xxxu_save_mac_regs(priv, iqk_mac_regs, priv->mac_backup);
5401                 rtl8xxxu_save_regs(priv, iqk_bb_regs,
5402                                    priv->bb_backup, RTL8XXXU_BB_REGS);
5403         }
5404
5405         rtl8xxxu_path_adda_on(priv, adda_regs, true);
5406
5407         if (t == 0) {
5408                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_XA_HSSI_PARM1);
5409                 if (val32 & FPGA0_HSSI_PARM1_PI)
5410                         priv->pi_enabled = 1;
5411         }
5412
5413         if (!priv->pi_enabled) {
5414                 /* Switch BB to PI mode to do IQ Calibration. */
5415                 rtl8xxxu_write32(priv, REG_FPGA0_XA_HSSI_PARM1, 0x01000100);
5416                 rtl8xxxu_write32(priv, REG_FPGA0_XB_HSSI_PARM1, 0x01000100);
5417         }
5418
5419         val32 = rtl8xxxu_read32(priv, REG_FPGA0_RF_MODE);
5420         val32 &= ~FPGA_RF_MODE_CCK;
5421         rtl8xxxu_write32(priv, REG_FPGA0_RF_MODE, val32);
5422
5423         rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, 0x03a05600);
5424         rtl8xxxu_write32(priv, REG_OFDM0_TR_MUX_PAR, 0x000800e4);
5425         rtl8xxxu_write32(priv, REG_FPGA0_XCD_RF_SW_CTRL, 0x22204000);
5426
5427         val32 = rtl8xxxu_read32(priv, REG_FPGA0_XAB_RF_SW_CTRL);
5428         val32 |= (FPGA0_RF_PAPE | (FPGA0_RF_PAPE << FPGA0_RF_BD_CTRL_SHIFT));
5429         rtl8xxxu_write32(priv, REG_FPGA0_XAB_RF_SW_CTRL, val32);
5430
5431         val32 = rtl8xxxu_read32(priv, REG_FPGA0_XA_RF_INT_OE);
5432         val32 &= ~BIT(10);
5433         rtl8xxxu_write32(priv, REG_FPGA0_XA_RF_INT_OE, val32);
5434         val32 = rtl8xxxu_read32(priv, REG_FPGA0_XB_RF_INT_OE);
5435         val32 &= ~BIT(10);
5436         rtl8xxxu_write32(priv, REG_FPGA0_XB_RF_INT_OE, val32);
5437
5438         if (priv->tx_paths > 1) {
5439                 rtl8xxxu_write32(priv, REG_FPGA0_XA_LSSI_PARM, 0x00010000);
5440                 rtl8xxxu_write32(priv, REG_FPGA0_XB_LSSI_PARM, 0x00010000);
5441         }
5442
5443         /* MAC settings */
5444         rtl8xxxu_mac_calibration(priv, iqk_mac_regs, priv->mac_backup);
5445
5446         /* Page B init */
5447         rtl8xxxu_write32(priv, REG_CONFIG_ANT_A, 0x00080000);
5448
5449         if (priv->tx_paths > 1)
5450                 rtl8xxxu_write32(priv, REG_CONFIG_ANT_B, 0x00080000);
5451
5452         /* IQ calibration setting */
5453         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x80800000);
5454         rtl8xxxu_write32(priv, REG_TX_IQK, 0x01007c00);
5455         rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
5456
5457         for (i = 0; i < retry; i++) {
5458                 path_a_ok = rtl8xxxu_iqk_path_a(priv);
5459                 if (path_a_ok == 0x03) {
5460                         val32 = rtl8xxxu_read32(priv,
5461                                                 REG_TX_POWER_BEFORE_IQK_A);
5462                         result[t][0] = (val32 >> 16) & 0x3ff;
5463                         val32 = rtl8xxxu_read32(priv,
5464                                                 REG_TX_POWER_AFTER_IQK_A);
5465                         result[t][1] = (val32 >> 16) & 0x3ff;
5466                         val32 = rtl8xxxu_read32(priv,
5467                                                 REG_RX_POWER_BEFORE_IQK_A_2);
5468                         result[t][2] = (val32 >> 16) & 0x3ff;
5469                         val32 = rtl8xxxu_read32(priv,
5470                                                 REG_RX_POWER_AFTER_IQK_A_2);
5471                         result[t][3] = (val32 >> 16) & 0x3ff;
5472                         break;
5473                 } else if (i == (retry - 1) && path_a_ok == 0x01) {
5474                         /* TX IQK OK */
5475                         dev_dbg(dev, "%s: Path A IQK Only Tx Success!!\n",
5476                                 __func__);
5477
5478                         val32 = rtl8xxxu_read32(priv,
5479                                                 REG_TX_POWER_BEFORE_IQK_A);
5480                         result[t][0] = (val32 >> 16) & 0x3ff;
5481                         val32 = rtl8xxxu_read32(priv,
5482                                                 REG_TX_POWER_AFTER_IQK_A);
5483                         result[t][1] = (val32 >> 16) & 0x3ff;
5484                 }
5485         }
5486
5487         if (!path_a_ok)
5488                 dev_dbg(dev, "%s: Path A IQK failed!\n", __func__);
5489
5490         if (priv->tx_paths > 1) {
5491                 /*
5492                  * Path A into standby
5493                  */
5494                 rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x0);
5495                 rtl8xxxu_write32(priv, REG_FPGA0_XA_LSSI_PARM, 0x00010000);
5496                 rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x80800000);
5497
5498                 /* Turn Path B ADDA on */
5499                 rtl8xxxu_path_adda_on(priv, adda_regs, false);
5500
5501                 for (i = 0; i < retry; i++) {
5502                         path_b_ok = rtl8xxxu_iqk_path_b(priv);
5503                         if (path_b_ok == 0x03) {
5504                                 val32 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_B);
5505                                 result[t][4] = (val32 >> 16) & 0x3ff;
5506                                 val32 = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_B);
5507                                 result[t][5] = (val32 >> 16) & 0x3ff;
5508                                 val32 = rtl8xxxu_read32(priv, REG_RX_POWER_BEFORE_IQK_B_2);
5509                                 result[t][6] = (val32 >> 16) & 0x3ff;
5510                                 val32 = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_B_2);
5511                                 result[t][7] = (val32 >> 16) & 0x3ff;
5512                                 break;
5513                         } else if (i == (retry - 1) && path_b_ok == 0x01) {
5514                                 /* TX IQK OK */
5515                                 val32 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_B);
5516                                 result[t][4] = (val32 >> 16) & 0x3ff;
5517                                 val32 = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_B);
5518                                 result[t][5] = (val32 >> 16) & 0x3ff;
5519                         }
5520                 }
5521
5522                 if (!path_b_ok)
5523                         dev_dbg(dev, "%s: Path B IQK failed!\n", __func__);
5524         }
5525
5526         /* Back to BB mode, load original value */
5527         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0);
5528
5529         if (t) {
5530                 if (!priv->pi_enabled) {
5531                         /*
5532                          * Switch back BB to SI mode after finishing
5533                          * IQ Calibration
5534                          */
5535                         val32 = 0x01000000;
5536                         rtl8xxxu_write32(priv, REG_FPGA0_XA_HSSI_PARM1, val32);
5537                         rtl8xxxu_write32(priv, REG_FPGA0_XB_HSSI_PARM1, val32);
5538                 }
5539
5540                 /* Reload ADDA power saving parameters */
5541                 rtl8xxxu_restore_regs(priv, adda_regs, priv->adda_backup,
5542                                       RTL8XXXU_ADDA_REGS);
5543
5544                 /* Reload MAC parameters */
5545                 rtl8xxxu_restore_mac_regs(priv, iqk_mac_regs, priv->mac_backup);
5546
5547                 /* Reload BB parameters */
5548                 rtl8xxxu_restore_regs(priv, iqk_bb_regs,
5549                                       priv->bb_backup, RTL8XXXU_BB_REGS);
5550
5551                 /* Restore RX initial gain */
5552                 rtl8xxxu_write32(priv, REG_FPGA0_XA_LSSI_PARM, 0x00032ed3);
5553
5554                 if (priv->tx_paths > 1) {
5555                         rtl8xxxu_write32(priv, REG_FPGA0_XB_LSSI_PARM,
5556                                          0x00032ed3);
5557                 }
5558
5559                 /* Load 0xe30 IQC default value */
5560                 rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x01008c00);
5561                 rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x01008c00);
5562         }
5563 }
5564
5565 static void rtl8723bu_phy_iqcalibrate(struct rtl8xxxu_priv *priv,
5566                                       int result[][8], int t)
5567 {
5568         struct device *dev = &priv->udev->dev;
5569         u32 i, val32;
5570         int path_a_ok /*, path_b_ok */;
5571         int retry = 2;
5572         const u32 adda_regs[RTL8XXXU_ADDA_REGS] = {
5573                 REG_FPGA0_XCD_SWITCH_CTRL, REG_BLUETOOTH,
5574                 REG_RX_WAIT_CCA, REG_TX_CCK_RFON,
5575                 REG_TX_CCK_BBON, REG_TX_OFDM_RFON,
5576                 REG_TX_OFDM_BBON, REG_TX_TO_RX,
5577                 REG_TX_TO_TX, REG_RX_CCK,
5578                 REG_RX_OFDM, REG_RX_WAIT_RIFS,
5579                 REG_RX_TO_RX, REG_STANDBY,
5580                 REG_SLEEP, REG_PMPD_ANAEN
5581         };
5582         const u32 iqk_mac_regs[RTL8XXXU_MAC_REGS] = {
5583                 REG_TXPAUSE, REG_BEACON_CTRL,
5584                 REG_BEACON_CTRL_1, REG_GPIO_MUXCFG
5585         };
5586         const u32 iqk_bb_regs[RTL8XXXU_BB_REGS] = {
5587                 REG_OFDM0_TRX_PATH_ENABLE, REG_OFDM0_TR_MUX_PAR,
5588                 REG_FPGA0_XCD_RF_SW_CTRL, REG_CONFIG_ANT_A, REG_CONFIG_ANT_B,
5589                 REG_FPGA0_XAB_RF_SW_CTRL, REG_FPGA0_XA_RF_INT_OE,
5590                 REG_FPGA0_XB_RF_INT_OE, REG_FPGA0_RF_MODE
5591         };
5592         u8 xa_agc = rtl8xxxu_read32(priv, REG_OFDM0_XA_AGC_CORE1) & 0xff;
5593         u8 xb_agc = rtl8xxxu_read32(priv, REG_OFDM0_XB_AGC_CORE1) & 0xff;
5594
5595         /*
5596          * Note: IQ calibration must be performed after loading
5597          *       PHY_REG.txt , and radio_a, radio_b.txt
5598          */
5599
5600         if (t == 0) {
5601                 /* Save ADDA parameters, turn Path A ADDA on */
5602                 rtl8xxxu_save_regs(priv, adda_regs, priv->adda_backup,
5603                                    RTL8XXXU_ADDA_REGS);
5604                 rtl8xxxu_save_mac_regs(priv, iqk_mac_regs, priv->mac_backup);
5605                 rtl8xxxu_save_regs(priv, iqk_bb_regs,
5606                                    priv->bb_backup, RTL8XXXU_BB_REGS);
5607         }
5608
5609         rtl8xxxu_path_adda_on(priv, adda_regs, true);
5610
5611         /* MAC settings */
5612         rtl8xxxu_mac_calibration(priv, iqk_mac_regs, priv->mac_backup);
5613
5614         val32 = rtl8xxxu_read32(priv, REG_CCK0_AFE_SETTING);
5615         val32 |= 0x0f000000;
5616         rtl8xxxu_write32(priv, REG_CCK0_AFE_SETTING, val32);
5617
5618         rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, 0x03a05600);
5619         rtl8xxxu_write32(priv, REG_OFDM0_TR_MUX_PAR, 0x000800e4);
5620         rtl8xxxu_write32(priv, REG_FPGA0_XCD_RF_SW_CTRL, 0x22204000);
5621
5622 #ifdef RTL8723BU_PATH_B
5623         /* Set RF mode to standby Path B */
5624         if (priv->tx_paths > 1)
5625                 rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_AC, 0x10000);
5626 #endif
5627
5628 #if 0
5629         /* Page B init */
5630         rtl8xxxu_write32(priv, REG_CONFIG_ANT_A, 0x0f600000);
5631
5632         if (priv->tx_paths > 1)
5633                 rtl8xxxu_write32(priv, REG_CONFIG_ANT_B, 0x0f600000);
5634 #endif
5635
5636         /*
5637          * RX IQ calibration setting for 8723B D cut large current issue
5638          * when leaving IPS
5639          */
5640         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
5641         val32 &= 0x000000ff;
5642         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
5643
5644         val32 = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_WE_LUT);
5645         val32 |= 0x80000;
5646         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_WE_LUT, val32);
5647
5648         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_RCK_OS, 0x30000);
5649         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G1, 0x0001f);
5650         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G2, 0xf7fb7);
5651
5652         val32 = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_ED);
5653         val32 |= 0x20;
5654         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_ED, val32);
5655
5656         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_43, 0x60fbd);
5657
5658         for (i = 0; i < retry; i++) {
5659                 path_a_ok = rtl8723bu_iqk_path_a(priv);
5660                 if (path_a_ok == 0x01) {
5661                         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
5662                         val32 &= 0x000000ff;
5663                         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
5664
5665 #if 0 /* Only needed in restore case, we may need this when going to suspend */
5666                         priv->RFCalibrateInfo.TxLOK[RF_A] =
5667                                 rtl8xxxu_read_rfreg(priv, RF_A,
5668                                                     RF6052_REG_TXM_IDAC);
5669 #endif
5670
5671                         val32 = rtl8xxxu_read32(priv,
5672                                                 REG_TX_POWER_BEFORE_IQK_A);
5673                         result[t][0] = (val32 >> 16) & 0x3ff;
5674                         val32 = rtl8xxxu_read32(priv,
5675                                                 REG_TX_POWER_AFTER_IQK_A);
5676                         result[t][1] = (val32 >> 16) & 0x3ff;
5677
5678                         break;
5679                 }
5680         }
5681
5682         if (!path_a_ok)
5683                 dev_dbg(dev, "%s: Path A TX IQK failed!\n", __func__);
5684
5685         for (i = 0; i < retry; i++) {
5686                 path_a_ok = rtl8723bu_rx_iqk_path_a(priv);
5687                 if (path_a_ok == 0x03) {
5688                         val32 = rtl8xxxu_read32(priv,
5689                                                 REG_RX_POWER_BEFORE_IQK_A_2);
5690                         result[t][2] = (val32 >> 16) & 0x3ff;
5691                         val32 = rtl8xxxu_read32(priv,
5692                                                 REG_RX_POWER_AFTER_IQK_A_2);
5693                         result[t][3] = (val32 >> 16) & 0x3ff;
5694
5695                         break;
5696                 }
5697         }
5698
5699         if (!path_a_ok)
5700                 dev_dbg(dev, "%s: Path A RX IQK failed!\n", __func__);
5701
5702         if (priv->tx_paths > 1) {
5703 #if 1
5704                 dev_warn(dev, "%s: Path B not supported\n", __func__);
5705 #else
5706
5707                 /*
5708                  * Path A into standby
5709                  */
5710                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
5711                 val32 &= 0x000000ff;
5712                 rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
5713                 rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_AC, 0x10000);
5714
5715                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
5716                 val32 &= 0x000000ff;
5717                 val32 |= 0x80800000;
5718                 rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
5719
5720                 /* Turn Path B ADDA on */
5721                 rtl8xxxu_path_adda_on(priv, adda_regs, false);
5722
5723                 for (i = 0; i < retry; i++) {
5724                         path_b_ok = rtl8xxxu_iqk_path_b(priv);
5725                         if (path_b_ok == 0x03) {
5726                                 val32 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_B);
5727                                 result[t][4] = (val32 >> 16) & 0x3ff;
5728                                 val32 = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_B);
5729                                 result[t][5] = (val32 >> 16) & 0x3ff;
5730                                 break;
5731                         }
5732                 }
5733
5734                 if (!path_b_ok)
5735                         dev_dbg(dev, "%s: Path B IQK failed!\n", __func__);
5736
5737                 for (i = 0; i < retry; i++) {
5738                         path_b_ok = rtl8723bu_rx_iqk_path_b(priv);
5739                         if (path_a_ok == 0x03) {
5740                                 val32 = rtl8xxxu_read32(priv,
5741                                                         REG_RX_POWER_BEFORE_IQK_B_2);
5742                                 result[t][6] = (val32 >> 16) & 0x3ff;
5743                                 val32 = rtl8xxxu_read32(priv,
5744                                                         REG_RX_POWER_AFTER_IQK_B_2);
5745                                 result[t][7] = (val32 >> 16) & 0x3ff;
5746                                 break;
5747                         }
5748                 }
5749
5750                 if (!path_b_ok)
5751                         dev_dbg(dev, "%s: Path B RX IQK failed!\n", __func__);
5752 #endif
5753         }
5754
5755         /* Back to BB mode, load original value */
5756         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
5757         val32 &= 0x000000ff;
5758         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
5759
5760         if (t) {
5761                 /* Reload ADDA power saving parameters */
5762                 rtl8xxxu_restore_regs(priv, adda_regs, priv->adda_backup,
5763                                       RTL8XXXU_ADDA_REGS);
5764
5765                 /* Reload MAC parameters */
5766                 rtl8xxxu_restore_mac_regs(priv, iqk_mac_regs, priv->mac_backup);
5767
5768                 /* Reload BB parameters */
5769                 rtl8xxxu_restore_regs(priv, iqk_bb_regs,
5770                                       priv->bb_backup, RTL8XXXU_BB_REGS);
5771
5772                 /* Restore RX initial gain */
5773                 val32 = rtl8xxxu_read32(priv, REG_OFDM0_XA_AGC_CORE1);
5774                 val32 &= 0xffffff00;
5775                 rtl8xxxu_write32(priv, REG_OFDM0_XA_AGC_CORE1, val32 | 0x50);
5776                 rtl8xxxu_write32(priv, REG_OFDM0_XA_AGC_CORE1, val32 | xa_agc);
5777
5778                 if (priv->tx_paths > 1) {
5779                         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XB_AGC_CORE1);
5780                         val32 &= 0xffffff00;
5781                         rtl8xxxu_write32(priv, REG_OFDM0_XB_AGC_CORE1,
5782                                          val32 | 0x50);
5783                         rtl8xxxu_write32(priv, REG_OFDM0_XB_AGC_CORE1,
5784                                          val32 | xb_agc);
5785                 }
5786
5787                 /* Load 0xe30 IQC default value */
5788                 rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x01008c00);
5789                 rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x01008c00);
5790         }
5791 }
5792
5793 static void rtl8192eu_phy_iqcalibrate(struct rtl8xxxu_priv *priv,
5794                                       int result[][8], int t)
5795 {
5796         struct device *dev = &priv->udev->dev;
5797         u32 i, val32;
5798         int path_a_ok, path_b_ok;
5799         int retry = 2;
5800         const u32 adda_regs[RTL8XXXU_ADDA_REGS] = {
5801                 REG_FPGA0_XCD_SWITCH_CTRL, REG_BLUETOOTH,
5802                 REG_RX_WAIT_CCA, REG_TX_CCK_RFON,
5803                 REG_TX_CCK_BBON, REG_TX_OFDM_RFON,
5804                 REG_TX_OFDM_BBON, REG_TX_TO_RX,
5805                 REG_TX_TO_TX, REG_RX_CCK,
5806                 REG_RX_OFDM, REG_RX_WAIT_RIFS,
5807                 REG_RX_TO_RX, REG_STANDBY,
5808                 REG_SLEEP, REG_PMPD_ANAEN
5809         };
5810         const u32 iqk_mac_regs[RTL8XXXU_MAC_REGS] = {
5811                 REG_TXPAUSE, REG_BEACON_CTRL,
5812                 REG_BEACON_CTRL_1, REG_GPIO_MUXCFG
5813         };
5814         const u32 iqk_bb_regs[RTL8XXXU_BB_REGS] = {
5815                 REG_OFDM0_TRX_PATH_ENABLE, REG_OFDM0_TR_MUX_PAR,
5816                 REG_FPGA0_XCD_RF_SW_CTRL, REG_CONFIG_ANT_A, REG_CONFIG_ANT_B,
5817                 REG_FPGA0_XAB_RF_SW_CTRL, REG_FPGA0_XA_RF_INT_OE,
5818                 REG_FPGA0_XB_RF_INT_OE, REG_CCK0_AFE_SETTING
5819         };
5820         u8 xa_agc = rtl8xxxu_read32(priv, REG_OFDM0_XA_AGC_CORE1) & 0xff;
5821         u8 xb_agc = rtl8xxxu_read32(priv, REG_OFDM0_XB_AGC_CORE1) & 0xff;
5822
5823         /*
5824          * Note: IQ calibration must be performed after loading
5825          *       PHY_REG.txt , and radio_a, radio_b.txt
5826          */
5827
5828         if (t == 0) {
5829                 /* Save ADDA parameters, turn Path A ADDA on */
5830                 rtl8xxxu_save_regs(priv, adda_regs, priv->adda_backup,
5831                                    RTL8XXXU_ADDA_REGS);
5832                 rtl8xxxu_save_mac_regs(priv, iqk_mac_regs, priv->mac_backup);
5833                 rtl8xxxu_save_regs(priv, iqk_bb_regs,
5834                                    priv->bb_backup, RTL8XXXU_BB_REGS);
5835         }
5836
5837         rtl8xxxu_path_adda_on(priv, adda_regs, true);
5838
5839         /* MAC settings */
5840         rtl8xxxu_mac_calibration(priv, iqk_mac_regs, priv->mac_backup);
5841
5842         val32 = rtl8xxxu_read32(priv, REG_CCK0_AFE_SETTING);
5843         val32 |= 0x0f000000;
5844         rtl8xxxu_write32(priv, REG_CCK0_AFE_SETTING, val32);
5845
5846         rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, 0x03a05600);
5847         rtl8xxxu_write32(priv, REG_OFDM0_TR_MUX_PAR, 0x000800e4);
5848         rtl8xxxu_write32(priv, REG_FPGA0_XCD_RF_SW_CTRL, 0x22208200);
5849
5850         val32 = rtl8xxxu_read32(priv, REG_FPGA0_XAB_RF_SW_CTRL);
5851         val32 |= (FPGA0_RF_PAPE | (FPGA0_RF_PAPE << FPGA0_RF_BD_CTRL_SHIFT));
5852         rtl8xxxu_write32(priv, REG_FPGA0_XAB_RF_SW_CTRL, val32);
5853
5854         val32 = rtl8xxxu_read32(priv, REG_FPGA0_XA_RF_INT_OE);
5855         val32 |= BIT(10);
5856         rtl8xxxu_write32(priv, REG_FPGA0_XA_RF_INT_OE, val32);
5857         val32 = rtl8xxxu_read32(priv, REG_FPGA0_XB_RF_INT_OE);
5858         val32 |= BIT(10);
5859         rtl8xxxu_write32(priv, REG_FPGA0_XB_RF_INT_OE, val32);
5860
5861         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x80800000);
5862         rtl8xxxu_write32(priv, REG_TX_IQK, 0x01007c00);
5863         rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
5864
5865         for (i = 0; i < retry; i++) {
5866                 path_a_ok = rtl8192eu_iqk_path_a(priv);
5867                 if (path_a_ok == 0x01) {
5868                         val32 = rtl8xxxu_read32(priv,
5869                                                 REG_TX_POWER_BEFORE_IQK_A);
5870                         result[t][0] = (val32 >> 16) & 0x3ff;
5871                         val32 = rtl8xxxu_read32(priv,
5872                                                 REG_TX_POWER_AFTER_IQK_A);
5873                         result[t][1] = (val32 >> 16) & 0x3ff;
5874
5875                         break;
5876                 }
5877         }
5878
5879         if (!path_a_ok)
5880                 dev_dbg(dev, "%s: Path A TX IQK failed!\n", __func__);
5881
5882         for (i = 0; i < retry; i++) {
5883                 path_a_ok = rtl8192eu_rx_iqk_path_a(priv);
5884                 if (path_a_ok == 0x03) {
5885                         val32 = rtl8xxxu_read32(priv,
5886                                                 REG_RX_POWER_BEFORE_IQK_A_2);
5887                         result[t][2] = (val32 >> 16) & 0x3ff;
5888                         val32 = rtl8xxxu_read32(priv,
5889                                                 REG_RX_POWER_AFTER_IQK_A_2);
5890                         result[t][3] = (val32 >> 16) & 0x3ff;
5891
5892                         break;
5893                 }
5894         }
5895
5896         if (!path_a_ok)
5897                 dev_dbg(dev, "%s: Path A RX IQK failed!\n", __func__);
5898
5899         if (priv->rf_paths > 1) {
5900                 dev_warn(dev, "%s: Path B ongoing\n", __func__);
5901
5902                 /* Path A into standby */
5903                 rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00000000);
5904                 rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_AC, 0x10000);
5905                 rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x80800000);
5906
5907                 /* Turn Path B ADDA on */
5908                 rtl8xxxu_path_adda_on(priv, adda_regs, false);
5909
5910                 rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x80800000);
5911                 rtl8xxxu_write32(priv, REG_TX_IQK, 0x01007c00);
5912                 rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
5913
5914                 for (i = 0; i < retry; i++) {
5915                         path_b_ok = rtl8192eu_iqk_path_b(priv);
5916                         if (path_b_ok == 0x01) {
5917                                 val32 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_B);
5918                                 result[t][4] = (val32 >> 16) & 0x3ff;
5919                                 val32 = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_B);
5920                                 result[t][5] = (val32 >> 16) & 0x3ff;
5921                                 break;
5922                         }
5923                 }
5924
5925                 if (!path_b_ok)
5926                         dev_dbg(dev, "%s: Path B IQK failed!\n", __func__);
5927
5928                 for (i = 0; i < retry; i++) {
5929                         path_b_ok = rtl8192eu_rx_iqk_path_b(priv);
5930                         if (path_a_ok == 0x03) {
5931                                 val32 = rtl8xxxu_read32(priv,
5932                                                         REG_RX_POWER_BEFORE_IQK_B_2);
5933                                 result[t][6] = (val32 >> 16) & 0x3ff;
5934                                 val32 = rtl8xxxu_read32(priv,
5935                                                         REG_RX_POWER_AFTER_IQK_B_2);
5936                                 result[t][7] = (val32 >> 16) & 0x3ff;
5937                                 break;
5938                         }
5939                 }
5940
5941                 if (!path_b_ok)
5942                         dev_dbg(dev, "%s: Path B RX IQK failed!\n", __func__);
5943         }
5944
5945         /* Back to BB mode, load original value */
5946         rtl8xxxu_write32(priv, REG_FPGA0_IQK, 0x00000000);
5947
5948         if (t) {
5949                 /* Reload ADDA power saving parameters */
5950                 rtl8xxxu_restore_regs(priv, adda_regs, priv->adda_backup,
5951                                       RTL8XXXU_ADDA_REGS);
5952
5953                 /* Reload MAC parameters */
5954                 rtl8xxxu_restore_mac_regs(priv, iqk_mac_regs, priv->mac_backup);
5955
5956                 /* Reload BB parameters */
5957                 rtl8xxxu_restore_regs(priv, iqk_bb_regs,
5958                                       priv->bb_backup, RTL8XXXU_BB_REGS);
5959
5960                 /* Restore RX initial gain */
5961                 val32 = rtl8xxxu_read32(priv, REG_OFDM0_XA_AGC_CORE1);
5962                 val32 &= 0xffffff00;
5963                 rtl8xxxu_write32(priv, REG_OFDM0_XA_AGC_CORE1, val32 | 0x50);
5964                 rtl8xxxu_write32(priv, REG_OFDM0_XA_AGC_CORE1, val32 | xa_agc);
5965
5966                 if (priv->rf_paths > 1) {
5967                         val32 = rtl8xxxu_read32(priv, REG_OFDM0_XB_AGC_CORE1);
5968                         val32 &= 0xffffff00;
5969                         rtl8xxxu_write32(priv, REG_OFDM0_XB_AGC_CORE1,
5970                                          val32 | 0x50);
5971                         rtl8xxxu_write32(priv, REG_OFDM0_XB_AGC_CORE1,
5972                                          val32 | xb_agc);
5973                 }
5974
5975                 /* Load 0xe30 IQC default value */
5976                 rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x01008c00);
5977                 rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x01008c00);
5978         }
5979 }
5980
5981 static void rtl8xxxu_prepare_calibrate(struct rtl8xxxu_priv *priv, u8 start)
5982 {
5983         struct h2c_cmd h2c;
5984
5985         if (priv->fops->mbox_ext_width < 4)
5986                 return;
5987
5988         memset(&h2c, 0, sizeof(struct h2c_cmd));
5989         h2c.bt_wlan_calibration.cmd = H2C_8723B_BT_WLAN_CALIBRATION;
5990         h2c.bt_wlan_calibration.data = start;
5991
5992         rtl8723a_h2c_cmd(priv, &h2c, sizeof(h2c.bt_wlan_calibration));
5993 }
5994
5995 static void rtl8723au_phy_iq_calibrate(struct rtl8xxxu_priv *priv)
5996 {
5997         struct device *dev = &priv->udev->dev;
5998         int result[4][8];       /* last is final result */
5999         int i, candidate;
6000         bool path_a_ok, path_b_ok;
6001         u32 reg_e94, reg_e9c, reg_ea4, reg_eac;
6002         u32 reg_eb4, reg_ebc, reg_ec4, reg_ecc;
6003         s32 reg_tmp = 0;
6004         bool simu;
6005
6006         rtl8xxxu_prepare_calibrate(priv, 1);
6007
6008         memset(result, 0, sizeof(result));
6009         candidate = -1;
6010
6011         path_a_ok = false;
6012         path_b_ok = false;
6013
6014         rtl8xxxu_read32(priv, REG_FPGA0_RF_MODE);
6015
6016         for (i = 0; i < 3; i++) {
6017                 rtl8xxxu_phy_iqcalibrate(priv, result, i);
6018
6019                 if (i == 1) {
6020                         simu = rtl8xxxu_simularity_compare(priv, result, 0, 1);
6021                         if (simu) {
6022                                 candidate = 0;
6023                                 break;
6024                         }
6025                 }
6026
6027                 if (i == 2) {
6028                         simu = rtl8xxxu_simularity_compare(priv, result, 0, 2);
6029                         if (simu) {
6030                                 candidate = 0;
6031                                 break;
6032                         }
6033
6034                         simu = rtl8xxxu_simularity_compare(priv, result, 1, 2);
6035                         if (simu) {
6036                                 candidate = 1;
6037                         } else {
6038                                 for (i = 0; i < 8; i++)
6039                                         reg_tmp += result[3][i];
6040
6041                                 if (reg_tmp)
6042                                         candidate = 3;
6043                                 else
6044                                         candidate = -1;
6045                         }
6046                 }
6047         }
6048
6049         for (i = 0; i < 4; i++) {
6050                 reg_e94 = result[i][0];
6051                 reg_e9c = result[i][1];
6052                 reg_ea4 = result[i][2];
6053                 reg_eac = result[i][3];
6054                 reg_eb4 = result[i][4];
6055                 reg_ebc = result[i][5];
6056                 reg_ec4 = result[i][6];
6057                 reg_ecc = result[i][7];
6058         }
6059
6060         if (candidate >= 0) {
6061                 reg_e94 = result[candidate][0];
6062                 priv->rege94 =  reg_e94;
6063                 reg_e9c = result[candidate][1];
6064                 priv->rege9c = reg_e9c;
6065                 reg_ea4 = result[candidate][2];
6066                 reg_eac = result[candidate][3];
6067                 reg_eb4 = result[candidate][4];
6068                 priv->regeb4 = reg_eb4;
6069                 reg_ebc = result[candidate][5];
6070                 priv->regebc = reg_ebc;
6071                 reg_ec4 = result[candidate][6];
6072                 reg_ecc = result[candidate][7];
6073                 dev_dbg(dev, "%s: candidate is %x\n", __func__, candidate);
6074                 dev_dbg(dev,
6075                         "%s: e94 =%x e9c=%x ea4=%x eac=%x eb4=%x ebc=%x ec4=%x "
6076                         "ecc=%x\n ", __func__, reg_e94, reg_e9c,
6077                         reg_ea4, reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc);
6078                 path_a_ok = true;
6079                 path_b_ok = true;
6080         } else {
6081                 reg_e94 = reg_eb4 = priv->rege94 = priv->regeb4 = 0x100;
6082                 reg_e9c = reg_ebc = priv->rege9c = priv->regebc = 0x0;
6083         }
6084
6085         if (reg_e94 && candidate >= 0)
6086                 rtl8xxxu_fill_iqk_matrix_a(priv, path_a_ok, result,
6087                                            candidate, (reg_ea4 == 0));
6088
6089         if (priv->tx_paths > 1 && reg_eb4)
6090                 rtl8xxxu_fill_iqk_matrix_b(priv, path_b_ok, result,
6091                                            candidate, (reg_ec4 == 0));
6092
6093         rtl8xxxu_save_regs(priv, rtl8723au_iqk_phy_iq_bb_reg,
6094                            priv->bb_recovery_backup, RTL8XXXU_BB_REGS);
6095
6096         rtl8xxxu_prepare_calibrate(priv, 0);
6097 }
6098
6099 static void rtl8723bu_phy_iq_calibrate(struct rtl8xxxu_priv *priv)
6100 {
6101         struct device *dev = &priv->udev->dev;
6102         int result[4][8];       /* last is final result */
6103         int i, candidate;
6104         bool path_a_ok, path_b_ok;
6105         u32 reg_e94, reg_e9c, reg_ea4, reg_eac;
6106         u32 reg_eb4, reg_ebc, reg_ec4, reg_ecc;
6107         u32 val32, bt_control;
6108         s32 reg_tmp = 0;
6109         bool simu;
6110
6111         rtl8xxxu_prepare_calibrate(priv, 1);
6112
6113         memset(result, 0, sizeof(result));
6114         candidate = -1;
6115
6116         path_a_ok = false;
6117         path_b_ok = false;
6118
6119         bt_control = rtl8xxxu_read32(priv, REG_BT_CONTROL_8723BU);
6120
6121         for (i = 0; i < 3; i++) {
6122                 rtl8723bu_phy_iqcalibrate(priv, result, i);
6123
6124                 if (i == 1) {
6125                         simu = rtl8723bu_simularity_compare(priv, result, 0, 1);
6126                         if (simu) {
6127                                 candidate = 0;
6128                                 break;
6129                         }
6130                 }
6131
6132                 if (i == 2) {
6133                         simu = rtl8723bu_simularity_compare(priv, result, 0, 2);
6134                         if (simu) {
6135                                 candidate = 0;
6136                                 break;
6137                         }
6138
6139                         simu = rtl8723bu_simularity_compare(priv, result, 1, 2);
6140                         if (simu) {
6141                                 candidate = 1;
6142                         } else {
6143                                 for (i = 0; i < 8; i++)
6144                                         reg_tmp += result[3][i];
6145
6146                                 if (reg_tmp)
6147                                         candidate = 3;
6148                                 else
6149                                         candidate = -1;
6150                         }
6151                 }
6152         }
6153
6154         for (i = 0; i < 4; i++) {
6155                 reg_e94 = result[i][0];
6156                 reg_e9c = result[i][1];
6157                 reg_ea4 = result[i][2];
6158                 reg_eac = result[i][3];
6159                 reg_eb4 = result[i][4];
6160                 reg_ebc = result[i][5];
6161                 reg_ec4 = result[i][6];
6162                 reg_ecc = result[i][7];
6163         }
6164
6165         if (candidate >= 0) {
6166                 reg_e94 = result[candidate][0];
6167                 priv->rege94 =  reg_e94;
6168                 reg_e9c = result[candidate][1];
6169                 priv->rege9c = reg_e9c;
6170                 reg_ea4 = result[candidate][2];
6171                 reg_eac = result[candidate][3];
6172                 reg_eb4 = result[candidate][4];
6173                 priv->regeb4 = reg_eb4;
6174                 reg_ebc = result[candidate][5];
6175                 priv->regebc = reg_ebc;
6176                 reg_ec4 = result[candidate][6];
6177                 reg_ecc = result[candidate][7];
6178                 dev_dbg(dev, "%s: candidate is %x\n", __func__, candidate);
6179                 dev_dbg(dev,
6180                         "%s: e94 =%x e9c=%x ea4=%x eac=%x eb4=%x ebc=%x ec4=%x "
6181                         "ecc=%x\n ", __func__, reg_e94, reg_e9c,
6182                         reg_ea4, reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc);
6183                 path_a_ok = true;
6184                 path_b_ok = true;
6185         } else {
6186                 reg_e94 = reg_eb4 = priv->rege94 = priv->regeb4 = 0x100;
6187                 reg_e9c = reg_ebc = priv->rege9c = priv->regebc = 0x0;
6188         }
6189
6190         if (reg_e94 && candidate >= 0)
6191                 rtl8xxxu_fill_iqk_matrix_a(priv, path_a_ok, result,
6192                                            candidate, (reg_ea4 == 0));
6193
6194         if (priv->tx_paths > 1 && reg_eb4)
6195                 rtl8xxxu_fill_iqk_matrix_b(priv, path_b_ok, result,
6196                                            candidate, (reg_ec4 == 0));
6197
6198         rtl8xxxu_save_regs(priv, rtl8723au_iqk_phy_iq_bb_reg,
6199                            priv->bb_recovery_backup, RTL8XXXU_BB_REGS);
6200
6201         rtl8xxxu_write32(priv, REG_BT_CONTROL_8723BU, bt_control);
6202
6203         val32 = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_WE_LUT);
6204         val32 |= 0x80000;
6205         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_WE_LUT, val32);
6206         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_RCK_OS, 0x18000);
6207         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G1, 0x0001f);
6208         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_TXPA_G2, 0xe6177);
6209         val32 = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_ED);
6210         val32 |= 0x20;
6211         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_UNKNOWN_ED, val32);
6212         rtl8xxxu_write_rfreg(priv, RF_A, 0x43, 0x300bd);
6213
6214         if (priv->rf_paths > 1) {
6215                 dev_dbg(dev, "%s: beware 2T not yet supported\n", __func__);
6216 #ifdef RTL8723BU_PATH_B
6217                 if (RF_Path == 0x0)     //S1
6218                         ODM_SetIQCbyRFpath(pDM_Odm, 0);
6219                 else    //S0
6220                         ODM_SetIQCbyRFpath(pDM_Odm, 1);
6221 #endif
6222         }
6223         rtl8xxxu_prepare_calibrate(priv, 0);
6224 }
6225
6226 static void rtl8192eu_phy_iq_calibrate(struct rtl8xxxu_priv *priv)
6227 {
6228         struct device *dev = &priv->udev->dev;
6229         int result[4][8];       /* last is final result */
6230         int i, candidate;
6231         bool path_a_ok, path_b_ok;
6232         u32 reg_e94, reg_e9c, reg_ea4, reg_eac;
6233         u32 reg_eb4, reg_ebc, reg_ec4, reg_ecc;
6234         bool simu;
6235
6236         memset(result, 0, sizeof(result));
6237         candidate = -1;
6238
6239         path_a_ok = false;
6240         path_b_ok = false;
6241
6242         for (i = 0; i < 3; i++) {
6243                 rtl8192eu_phy_iqcalibrate(priv, result, i);
6244
6245                 if (i == 1) {
6246                         simu = rtl8723bu_simularity_compare(priv, result, 0, 1);
6247                         if (simu) {
6248                                 candidate = 0;
6249                                 break;
6250                         }
6251                 }
6252
6253                 if (i == 2) {
6254                         simu = rtl8723bu_simularity_compare(priv, result, 0, 2);
6255                         if (simu) {
6256                                 candidate = 0;
6257                                 break;
6258                         }
6259
6260                         simu = rtl8723bu_simularity_compare(priv, result, 1, 2);
6261                         if (simu)
6262                                 candidate = 1;
6263                         else
6264                                 candidate = 3;
6265                 }
6266         }
6267
6268         for (i = 0; i < 4; i++) {
6269                 reg_e94 = result[i][0];
6270                 reg_e9c = result[i][1];
6271                 reg_ea4 = result[i][2];
6272                 reg_eac = result[i][3];
6273                 reg_eb4 = result[i][4];
6274                 reg_ebc = result[i][5];
6275                 reg_ec4 = result[i][6];
6276                 reg_ecc = result[i][7];
6277         }
6278
6279         if (candidate >= 0) {
6280                 reg_e94 = result[candidate][0];
6281                 priv->rege94 =  reg_e94;
6282                 reg_e9c = result[candidate][1];
6283                 priv->rege9c = reg_e9c;
6284                 reg_ea4 = result[candidate][2];
6285                 reg_eac = result[candidate][3];
6286                 reg_eb4 = result[candidate][4];
6287                 priv->regeb4 = reg_eb4;
6288                 reg_ebc = result[candidate][5];
6289                 priv->regebc = reg_ebc;
6290                 reg_ec4 = result[candidate][6];
6291                 reg_ecc = result[candidate][7];
6292                 dev_dbg(dev, "%s: candidate is %x\n", __func__, candidate);
6293                 dev_dbg(dev,
6294                         "%s: e94 =%x e9c=%x ea4=%x eac=%x eb4=%x ebc=%x ec4=%x "
6295                         "ecc=%x\n ", __func__, reg_e94, reg_e9c,
6296                         reg_ea4, reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc);
6297                 path_a_ok = true;
6298                 path_b_ok = true;
6299         } else {
6300                 reg_e94 = reg_eb4 = priv->rege94 = priv->regeb4 = 0x100;
6301                 reg_e9c = reg_ebc = priv->rege9c = priv->regebc = 0x0;
6302         }
6303
6304         if (reg_e94 && candidate >= 0)
6305                 rtl8xxxu_fill_iqk_matrix_a(priv, path_a_ok, result,
6306                                            candidate, (reg_ea4 == 0));
6307
6308         if (priv->rf_paths > 1)
6309                 rtl8xxxu_fill_iqk_matrix_b(priv, path_b_ok, result,
6310                                            candidate, (reg_ec4 == 0));
6311
6312         rtl8xxxu_save_regs(priv, rtl8723au_iqk_phy_iq_bb_reg,
6313                            priv->bb_recovery_backup, RTL8XXXU_BB_REGS);
6314 }
6315
6316 static void rtl8723a_phy_lc_calibrate(struct rtl8xxxu_priv *priv)
6317 {
6318         u32 val32;
6319         u32 rf_amode, rf_bmode = 0, lstf;
6320
6321         /* Check continuous TX and Packet TX */
6322         lstf = rtl8xxxu_read32(priv, REG_OFDM1_LSTF);
6323
6324         if (lstf & OFDM_LSTF_MASK) {
6325                 /* Disable all continuous TX */
6326                 val32 = lstf & ~OFDM_LSTF_MASK;
6327                 rtl8xxxu_write32(priv, REG_OFDM1_LSTF, val32);
6328
6329                 /* Read original RF mode Path A */
6330                 rf_amode = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_AC);
6331
6332                 /* Set RF mode to standby Path A */
6333                 rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_AC,
6334                                      (rf_amode & 0x8ffff) | 0x10000);
6335
6336                 /* Path-B */
6337                 if (priv->tx_paths > 1) {
6338                         rf_bmode = rtl8xxxu_read_rfreg(priv, RF_B,
6339                                                        RF6052_REG_AC);
6340
6341                         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_AC,
6342                                              (rf_bmode & 0x8ffff) | 0x10000);
6343                 }
6344         } else {
6345                 /*  Deal with Packet TX case */
6346                 /*  block all queues */
6347                 rtl8xxxu_write8(priv, REG_TXPAUSE, 0xff);
6348         }
6349
6350         /* Start LC calibration */
6351         if (priv->fops->has_s0s1)
6352                 rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_S0S1, 0xdfbe0);
6353         val32 = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_MODE_AG);
6354         val32 |= 0x08000;
6355         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_MODE_AG, val32);
6356
6357         msleep(100);
6358
6359         if (priv->fops->has_s0s1)
6360                 rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_S0S1, 0xdffe0);
6361
6362         /* Restore original parameters */
6363         if (lstf & OFDM_LSTF_MASK) {
6364                 /* Path-A */
6365                 rtl8xxxu_write32(priv, REG_OFDM1_LSTF, lstf);
6366                 rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_AC, rf_amode);
6367
6368                 /* Path-B */
6369                 if (priv->tx_paths > 1)
6370                         rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_AC,
6371                                              rf_bmode);
6372         } else /*  Deal with Packet TX case */
6373                 rtl8xxxu_write8(priv, REG_TXPAUSE, 0x00);
6374 }
6375
6376 static int rtl8xxxu_set_mac(struct rtl8xxxu_priv *priv)
6377 {
6378         int i;
6379         u16 reg;
6380
6381         reg = REG_MACID;
6382
6383         for (i = 0; i < ETH_ALEN; i++)
6384                 rtl8xxxu_write8(priv, reg + i, priv->mac_addr[i]);
6385
6386         return 0;
6387 }
6388
6389 static int rtl8xxxu_set_bssid(struct rtl8xxxu_priv *priv, const u8 *bssid)
6390 {
6391         int i;
6392         u16 reg;
6393
6394         dev_dbg(&priv->udev->dev, "%s: (%pM)\n", __func__, bssid);
6395
6396         reg = REG_BSSID;
6397
6398         for (i = 0; i < ETH_ALEN; i++)
6399                 rtl8xxxu_write8(priv, reg + i, bssid[i]);
6400
6401         return 0;
6402 }
6403
6404 static void
6405 rtl8xxxu_set_ampdu_factor(struct rtl8xxxu_priv *priv, u8 ampdu_factor)
6406 {
6407         u8 vals[4] = { 0x41, 0xa8, 0x72, 0xb9 };
6408         u8 max_agg = 0xf;
6409         int i;
6410
6411         ampdu_factor = 1 << (ampdu_factor + 2);
6412         if (ampdu_factor > max_agg)
6413                 ampdu_factor = max_agg;
6414
6415         for (i = 0; i < 4; i++) {
6416                 if ((vals[i] & 0xf0) > (ampdu_factor << 4))
6417                         vals[i] = (vals[i] & 0x0f) | (ampdu_factor << 4);
6418
6419                 if ((vals[i] & 0x0f) > ampdu_factor)
6420                         vals[i] = (vals[i] & 0xf0) | ampdu_factor;
6421
6422                 rtl8xxxu_write8(priv, REG_AGGLEN_LMT + i, vals[i]);
6423         }
6424 }
6425
6426 static void rtl8xxxu_set_ampdu_min_space(struct rtl8xxxu_priv *priv, u8 density)
6427 {
6428         u8 val8;
6429
6430         val8 = rtl8xxxu_read8(priv, REG_AMPDU_MIN_SPACE);
6431         val8 &= 0xf8;
6432         val8 |= density;
6433         rtl8xxxu_write8(priv, REG_AMPDU_MIN_SPACE, val8);
6434 }
6435
6436 static int rtl8xxxu_active_to_emu(struct rtl8xxxu_priv *priv)
6437 {
6438         u8 val8;
6439         int count, ret;
6440
6441         /* Start of rtl8723AU_card_enable_flow */
6442         /* Act to Cardemu sequence*/
6443         /* Turn off RF */
6444         rtl8xxxu_write8(priv, REG_RF_CTRL, 0);
6445
6446         /* 0x004E[7] = 0, switch DPDT_SEL_P output from register 0x0065[2] */
6447         val8 = rtl8xxxu_read8(priv, REG_LEDCFG2);
6448         val8 &= ~LEDCFG2_DPDT_SELECT;
6449         rtl8xxxu_write8(priv, REG_LEDCFG2, val8);
6450
6451         /* 0x0005[1] = 1 turn off MAC by HW state machine*/
6452         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6453         val8 |= BIT(1);
6454         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6455
6456         for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
6457                 val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6458                 if ((val8 & BIT(1)) == 0)
6459                         break;
6460                 udelay(10);
6461         }
6462
6463         if (!count) {
6464                 dev_warn(&priv->udev->dev, "%s: Disabling MAC timed out\n",
6465                          __func__);
6466                 ret = -EBUSY;
6467                 goto exit;
6468         }
6469
6470         /* 0x0000[5] = 1 analog Ips to digital, 1:isolation */
6471         val8 = rtl8xxxu_read8(priv, REG_SYS_ISO_CTRL);
6472         val8 |= SYS_ISO_ANALOG_IPS;
6473         rtl8xxxu_write8(priv, REG_SYS_ISO_CTRL, val8);
6474
6475         /* 0x0020[0] = 0 disable LDOA12 MACRO block*/
6476         val8 = rtl8xxxu_read8(priv, REG_LDOA15_CTRL);
6477         val8 &= ~LDOA15_ENABLE;
6478         rtl8xxxu_write8(priv, REG_LDOA15_CTRL, val8);
6479
6480 exit:
6481         return ret;
6482 }
6483
6484 static int rtl8723bu_active_to_emu(struct rtl8xxxu_priv *priv)
6485 {
6486         u8 val8;
6487         u16 val16;
6488         u32 val32;
6489         int count, ret;
6490
6491         /* Turn off RF */
6492         rtl8xxxu_write8(priv, REG_RF_CTRL, 0);
6493
6494         /* Enable rising edge triggering interrupt */
6495         val16 = rtl8xxxu_read16(priv, REG_GPIO_INTM);
6496         val16 &= ~GPIO_INTM_EDGE_TRIG_IRQ;
6497         rtl8xxxu_write16(priv, REG_GPIO_INTM, val16);
6498
6499         /* Release WLON reset 0x04[16]= 1*/
6500         val32 = rtl8xxxu_read32(priv, REG_GPIO_INTM);
6501         val32 |= APS_FSMCO_WLON_RESET;
6502         rtl8xxxu_write32(priv, REG_GPIO_INTM, val32);
6503
6504         /* 0x0005[1] = 1 turn off MAC by HW state machine*/
6505         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6506         val8 |= BIT(1);
6507         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6508
6509         for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
6510                 val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6511                 if ((val8 & BIT(1)) == 0)
6512                         break;
6513                 udelay(10);
6514         }
6515
6516         if (!count) {
6517                 dev_warn(&priv->udev->dev, "%s: Disabling MAC timed out\n",
6518                          __func__);
6519                 ret = -EBUSY;
6520                 goto exit;
6521         }
6522
6523         /* Enable BT control XTAL setting */
6524         val8 = rtl8xxxu_read8(priv, REG_AFE_MISC);
6525         val8 &= ~AFE_MISC_WL_XTAL_CTRL;
6526         rtl8xxxu_write8(priv, REG_AFE_MISC, val8);
6527
6528         /* 0x0000[5] = 1 analog Ips to digital, 1:isolation */
6529         val8 = rtl8xxxu_read8(priv, REG_SYS_ISO_CTRL);
6530         val8 |= SYS_ISO_ANALOG_IPS;
6531         rtl8xxxu_write8(priv, REG_SYS_ISO_CTRL, val8);
6532
6533         /* 0x0020[0] = 0 disable LDOA12 MACRO block*/
6534         val8 = rtl8xxxu_read8(priv, REG_LDOA15_CTRL);
6535         val8 &= ~LDOA15_ENABLE;
6536         rtl8xxxu_write8(priv, REG_LDOA15_CTRL, val8);
6537
6538 exit:
6539         return ret;
6540 }
6541
6542 static int rtl8xxxu_active_to_lps(struct rtl8xxxu_priv *priv)
6543 {
6544         u8 val8;
6545         u8 val32;
6546         int count, ret;
6547
6548         rtl8xxxu_write8(priv, REG_TXPAUSE, 0xff);
6549
6550         /*
6551          * Poll - wait for RX packet to complete
6552          */
6553         for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
6554                 val32 = rtl8xxxu_read32(priv, 0x5f8);
6555                 if (!val32)
6556                         break;
6557                 udelay(10);
6558         }
6559
6560         if (!count) {
6561                 dev_warn(&priv->udev->dev,
6562                          "%s: RX poll timed out (0x05f8)\n", __func__);
6563                 ret = -EBUSY;
6564                 goto exit;
6565         }
6566
6567         /* Disable CCK and OFDM, clock gated */
6568         val8 = rtl8xxxu_read8(priv, REG_SYS_FUNC);
6569         val8 &= ~SYS_FUNC_BBRSTB;
6570         rtl8xxxu_write8(priv, REG_SYS_FUNC, val8);
6571
6572         udelay(2);
6573
6574         /* Reset baseband */
6575         val8 = rtl8xxxu_read8(priv, REG_SYS_FUNC);
6576         val8 &= ~SYS_FUNC_BB_GLB_RSTN;
6577         rtl8xxxu_write8(priv, REG_SYS_FUNC, val8);
6578
6579         /* Reset MAC TRX */
6580         val8 = rtl8xxxu_read8(priv, REG_CR);
6581         val8 = CR_HCI_TXDMA_ENABLE | CR_HCI_RXDMA_ENABLE;
6582         rtl8xxxu_write8(priv, REG_CR, val8);
6583
6584         /* Reset MAC TRX */
6585         val8 = rtl8xxxu_read8(priv, REG_CR + 1);
6586         val8 &= ~BIT(1); /* CR_SECURITY_ENABLE */
6587         rtl8xxxu_write8(priv, REG_CR + 1, val8);
6588
6589         /* Respond TX OK to scheduler */
6590         val8 = rtl8xxxu_read8(priv, REG_DUAL_TSF_RST);
6591         val8 |= DUAL_TSF_TX_OK;
6592         rtl8xxxu_write8(priv, REG_DUAL_TSF_RST, val8);
6593
6594 exit:
6595         return ret;
6596 }
6597
6598 static void rtl8723a_disabled_to_emu(struct rtl8xxxu_priv *priv)
6599 {
6600         u8 val8;
6601
6602         /* Clear suspend enable and power down enable*/
6603         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6604         val8 &= ~(BIT(3) | BIT(7));
6605         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6606
6607         /* 0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/
6608         val8 = rtl8xxxu_read8(priv, REG_GPIO_INTM + 2);
6609         val8 &= ~BIT(0);
6610         rtl8xxxu_write8(priv, REG_GPIO_INTM + 2, val8);
6611
6612         /* 0x04[12:11] = 11 enable WL suspend*/
6613         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6614         val8 &= ~(BIT(3) | BIT(4));
6615         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6616 }
6617
6618 static void rtl8192e_disabled_to_emu(struct rtl8xxxu_priv *priv)
6619 {
6620         u8 val8;
6621
6622         /* Clear suspend enable and power down enable*/
6623         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6624         val8 &= ~(BIT(3) | BIT(4));
6625         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6626 }
6627
6628 static int rtl8192e_emu_to_active(struct rtl8xxxu_priv *priv)
6629 {
6630         u8 val8;
6631         u32 val32;
6632         int count, ret = 0;
6633
6634         /* disable HWPDN 0x04[15]=0*/
6635         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6636         val8 &= ~BIT(7);
6637         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6638
6639         /* disable SW LPS 0x04[10]= 0 */
6640         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6641         val8 &= ~BIT(2);
6642         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6643
6644         /* disable WL suspend*/
6645         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6646         val8 &= ~(BIT(3) | BIT(4));
6647         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6648
6649         /* wait till 0x04[17] = 1 power ready*/
6650         for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
6651                 val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
6652                 if (val32 & BIT(17))
6653                         break;
6654
6655                 udelay(10);
6656         }
6657
6658         if (!count) {
6659                 ret = -EBUSY;
6660                 goto exit;
6661         }
6662
6663         /* We should be able to optimize the following three entries into one */
6664
6665         /* release WLON reset 0x04[16]= 1*/
6666         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 2);
6667         val8 |= BIT(0);
6668         rtl8xxxu_write8(priv, REG_APS_FSMCO + 2, val8);
6669
6670         /* set, then poll until 0 */
6671         val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
6672         val32 |= APS_FSMCO_MAC_ENABLE;
6673         rtl8xxxu_write32(priv, REG_APS_FSMCO, val32);
6674
6675         for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
6676                 val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
6677                 if ((val32 & APS_FSMCO_MAC_ENABLE) == 0) {
6678                         ret = 0;
6679                         break;
6680                 }
6681                 udelay(10);
6682         }
6683
6684         if (!count) {
6685                 ret = -EBUSY;
6686                 goto exit;
6687         }
6688
6689 exit:
6690         return ret;
6691 }
6692
6693 static int rtl8723a_emu_to_active(struct rtl8xxxu_priv *priv)
6694 {
6695         u8 val8;
6696         u32 val32;
6697         int count, ret = 0;
6698
6699         /* 0x20[0] = 1 enable LDOA12 MACRO block for all interface*/
6700         val8 = rtl8xxxu_read8(priv, REG_LDOA15_CTRL);
6701         val8 |= LDOA15_ENABLE;
6702         rtl8xxxu_write8(priv, REG_LDOA15_CTRL, val8);
6703
6704         /* 0x67[0] = 0 to disable BT_GPS_SEL pins*/
6705         val8 = rtl8xxxu_read8(priv, 0x0067);
6706         val8 &= ~BIT(4);
6707         rtl8xxxu_write8(priv, 0x0067, val8);
6708
6709         mdelay(1);
6710
6711         /* 0x00[5] = 0 release analog Ips to digital, 1:isolation */
6712         val8 = rtl8xxxu_read8(priv, REG_SYS_ISO_CTRL);
6713         val8 &= ~SYS_ISO_ANALOG_IPS;
6714         rtl8xxxu_write8(priv, REG_SYS_ISO_CTRL, val8);
6715
6716         /* disable SW LPS 0x04[10]= 0 */
6717         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6718         val8 &= ~BIT(2);
6719         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6720
6721         /* wait till 0x04[17] = 1 power ready*/
6722         for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
6723                 val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
6724                 if (val32 & BIT(17))
6725                         break;
6726
6727                 udelay(10);
6728         }
6729
6730         if (!count) {
6731                 ret = -EBUSY;
6732                 goto exit;
6733         }
6734
6735         /* We should be able to optimize the following three entries into one */
6736
6737         /* release WLON reset 0x04[16]= 1*/
6738         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 2);
6739         val8 |= BIT(0);
6740         rtl8xxxu_write8(priv, REG_APS_FSMCO + 2, val8);
6741
6742         /* disable HWPDN 0x04[15]= 0*/
6743         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6744         val8 &= ~BIT(7);
6745         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6746
6747         /* disable WL suspend*/
6748         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6749         val8 &= ~(BIT(3) | BIT(4));
6750         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6751
6752         /* set, then poll until 0 */
6753         val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
6754         val32 |= APS_FSMCO_MAC_ENABLE;
6755         rtl8xxxu_write32(priv, REG_APS_FSMCO, val32);
6756
6757         for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
6758                 val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
6759                 if ((val32 & APS_FSMCO_MAC_ENABLE) == 0) {
6760                         ret = 0;
6761                         break;
6762                 }
6763                 udelay(10);
6764         }
6765
6766         if (!count) {
6767                 ret = -EBUSY;
6768                 goto exit;
6769         }
6770
6771         /* 0x4C[23] = 0x4E[7] = 1, switch DPDT_SEL_P output from WL BB */
6772         /*
6773          * Note: Vendor driver actually clears this bit, despite the
6774          * documentation claims it's being set!
6775          */
6776         val8 = rtl8xxxu_read8(priv, REG_LEDCFG2);
6777         val8 |= LEDCFG2_DPDT_SELECT;
6778         val8 &= ~LEDCFG2_DPDT_SELECT;
6779         rtl8xxxu_write8(priv, REG_LEDCFG2, val8);
6780
6781 exit:
6782         return ret;
6783 }
6784
6785 static int rtl8723b_emu_to_active(struct rtl8xxxu_priv *priv)
6786 {
6787         u8 val8;
6788         u32 val32;
6789         int count, ret = 0;
6790
6791         /* 0x20[0] = 1 enable LDOA12 MACRO block for all interface */
6792         val8 = rtl8xxxu_read8(priv, REG_LDOA15_CTRL);
6793         val8 |= LDOA15_ENABLE;
6794         rtl8xxxu_write8(priv, REG_LDOA15_CTRL, val8);
6795
6796         /* 0x67[0] = 0 to disable BT_GPS_SEL pins*/
6797         val8 = rtl8xxxu_read8(priv, 0x0067);
6798         val8 &= ~BIT(4);
6799         rtl8xxxu_write8(priv, 0x0067, val8);
6800
6801         mdelay(1);
6802
6803         /* 0x00[5] = 0 release analog Ips to digital, 1:isolation */
6804         val8 = rtl8xxxu_read8(priv, REG_SYS_ISO_CTRL);
6805         val8 &= ~SYS_ISO_ANALOG_IPS;
6806         rtl8xxxu_write8(priv, REG_SYS_ISO_CTRL, val8);
6807
6808         /* Disable SW LPS 0x04[10]= 0 */
6809         val32 = rtl8xxxu_read8(priv, REG_APS_FSMCO);
6810         val32 &= ~APS_FSMCO_SW_LPS;
6811         rtl8xxxu_write32(priv, REG_APS_FSMCO, val32);
6812
6813         /* Wait until 0x04[17] = 1 power ready */
6814         for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
6815                 val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
6816                 if (val32 & BIT(17))
6817                         break;
6818
6819                 udelay(10);
6820         }
6821
6822         if (!count) {
6823                 ret = -EBUSY;
6824                 goto exit;
6825         }
6826
6827         /* We should be able to optimize the following three entries into one */
6828
6829         /* Release WLON reset 0x04[16]= 1*/
6830         val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
6831         val32 |= APS_FSMCO_WLON_RESET;
6832         rtl8xxxu_write32(priv, REG_APS_FSMCO, val32);
6833
6834         /* Disable HWPDN 0x04[15]= 0*/
6835         val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
6836         val32 &= ~APS_FSMCO_HW_POWERDOWN;
6837         rtl8xxxu_write32(priv, REG_APS_FSMCO, val32);
6838
6839         /* Disable WL suspend*/
6840         val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
6841         val32 &= ~(APS_FSMCO_HW_SUSPEND | APS_FSMCO_PCIE);
6842         rtl8xxxu_write32(priv, REG_APS_FSMCO, val32);
6843
6844         /* Set, then poll until 0 */
6845         val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
6846         val32 |= APS_FSMCO_MAC_ENABLE;
6847         rtl8xxxu_write32(priv, REG_APS_FSMCO, val32);
6848
6849         for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
6850                 val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
6851                 if ((val32 & APS_FSMCO_MAC_ENABLE) == 0) {
6852                         ret = 0;
6853                         break;
6854                 }
6855                 udelay(10);
6856         }
6857
6858         if (!count) {
6859                 ret = -EBUSY;
6860                 goto exit;
6861         }
6862
6863         /* Enable WL control XTAL setting */
6864         val8 = rtl8xxxu_read8(priv, REG_AFE_MISC);
6865         val8 |= AFE_MISC_WL_XTAL_CTRL;
6866         rtl8xxxu_write8(priv, REG_AFE_MISC, val8);
6867
6868         /* Enable falling edge triggering interrupt */
6869         val8 = rtl8xxxu_read8(priv, REG_GPIO_INTM + 1);
6870         val8 |= BIT(1);
6871         rtl8xxxu_write8(priv, REG_GPIO_INTM + 1, val8);
6872
6873         /* Enable GPIO9 interrupt mode */
6874         val8 = rtl8xxxu_read8(priv, REG_GPIO_IO_SEL_2 + 1);
6875         val8 |= BIT(1);
6876         rtl8xxxu_write8(priv, REG_GPIO_IO_SEL_2 + 1, val8);
6877
6878         /* Enable GPIO9 input mode */
6879         val8 = rtl8xxxu_read8(priv, REG_GPIO_IO_SEL_2);
6880         val8 &= ~BIT(1);
6881         rtl8xxxu_write8(priv, REG_GPIO_IO_SEL_2, val8);
6882
6883         /* Enable HSISR GPIO[C:0] interrupt */
6884         val8 = rtl8xxxu_read8(priv, REG_HSIMR);
6885         val8 |= BIT(0);
6886         rtl8xxxu_write8(priv, REG_HSIMR, val8);
6887
6888         /* Enable HSISR GPIO9 interrupt */
6889         val8 = rtl8xxxu_read8(priv, REG_HSIMR + 2);
6890         val8 |= BIT(1);
6891         rtl8xxxu_write8(priv, REG_HSIMR + 2, val8);
6892
6893         val8 = rtl8xxxu_read8(priv, REG_MULTI_FUNC_CTRL);
6894         val8 |= MULTI_WIFI_HW_ROF_EN;
6895         rtl8xxxu_write8(priv, REG_MULTI_FUNC_CTRL, val8);
6896
6897         /* For GPIO9 internal pull high setting BIT(14) */
6898         val8 = rtl8xxxu_read8(priv, REG_MULTI_FUNC_CTRL + 1);
6899         val8 |= BIT(6);
6900         rtl8xxxu_write8(priv, REG_MULTI_FUNC_CTRL + 1, val8);
6901
6902 exit:
6903         return ret;
6904 }
6905
6906 static int rtl8xxxu_emu_to_disabled(struct rtl8xxxu_priv *priv)
6907 {
6908         u8 val8;
6909
6910         /* 0x0007[7:0] = 0x20 SOP option to disable BG/MB */
6911         rtl8xxxu_write8(priv, REG_APS_FSMCO + 3, 0x20);
6912
6913         /* 0x04[12:11] = 01 enable WL suspend */
6914         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6915         val8 &= ~BIT(4);
6916         val8 |= BIT(3);
6917         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6918
6919         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 1);
6920         val8 |= BIT(7);
6921         rtl8xxxu_write8(priv, REG_APS_FSMCO + 1, val8);
6922
6923         /* 0x48[16] = 1 to enable GPIO9 as EXT wakeup */
6924         val8 = rtl8xxxu_read8(priv, REG_GPIO_INTM + 2);
6925         val8 |= BIT(0);
6926         rtl8xxxu_write8(priv, REG_GPIO_INTM + 2, val8);
6927
6928         return 0;
6929 }
6930
6931 static int rtl8xxxu_flush_fifo(struct rtl8xxxu_priv *priv)
6932 {
6933         struct device *dev = &priv->udev->dev;
6934         u32 val32;
6935         int retry, retval;
6936
6937         rtl8xxxu_write8(priv, REG_TXPAUSE, 0xff);
6938
6939         val32 = rtl8xxxu_read32(priv, REG_RXPKT_NUM);
6940         val32 |= RXPKT_NUM_RW_RELEASE_EN;
6941         rtl8xxxu_write32(priv, REG_RXPKT_NUM, val32);
6942
6943         retry = 100;
6944         retval = -EBUSY;
6945
6946         do {
6947                 val32 = rtl8xxxu_read32(priv, REG_RXPKT_NUM);
6948                 if (val32 & RXPKT_NUM_RXDMA_IDLE) {
6949                         retval = 0;
6950                         break;
6951                 }
6952         } while (retry--);
6953
6954         rtl8xxxu_write16(priv, REG_RQPN_NPQ, 0);
6955         rtl8xxxu_write32(priv, REG_RQPN, 0x80000000);
6956         mdelay(2);
6957
6958         if (!retry)
6959                 dev_warn(dev, "Failed to flush FIFO\n");
6960
6961         return retval;
6962 }
6963
6964 static int rtl8723au_power_on(struct rtl8xxxu_priv *priv)
6965 {
6966         u8 val8;
6967         u16 val16;
6968         u32 val32;
6969         int ret;
6970
6971         /*
6972          * RSV_CTRL 0x001C[7:0] = 0x00, unlock ISO/CLK/Power control register
6973          */
6974         rtl8xxxu_write8(priv, REG_RSV_CTRL, 0x0);
6975
6976         rtl8723a_disabled_to_emu(priv);
6977
6978         ret = rtl8723a_emu_to_active(priv);
6979         if (ret)
6980                 goto exit;
6981
6982         /*
6983          * 0x0004[19] = 1, reset 8051
6984          */
6985         val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO + 2);
6986         val8 |= BIT(3);
6987         rtl8xxxu_write8(priv, REG_APS_FSMCO + 2, val8);
6988
6989         /*
6990          * Enable MAC DMA/WMAC/SCHEDULE/SEC block
6991          * Set CR bit10 to enable 32k calibration.
6992          */
6993         val16 = rtl8xxxu_read16(priv, REG_CR);
6994         val16 |= (CR_HCI_TXDMA_ENABLE | CR_HCI_RXDMA_ENABLE |
6995                   CR_TXDMA_ENABLE | CR_RXDMA_ENABLE |
6996                   CR_PROTOCOL_ENABLE | CR_SCHEDULE_ENABLE |
6997                   CR_MAC_TX_ENABLE | CR_MAC_RX_ENABLE |
6998                   CR_SECURITY_ENABLE | CR_CALTIMER_ENABLE);
6999         rtl8xxxu_write16(priv, REG_CR, val16);
7000
7001         /* For EFuse PG */
7002         val32 = rtl8xxxu_read32(priv, REG_EFUSE_CTRL);
7003         val32 &= ~(BIT(28) | BIT(29) | BIT(30));
7004         val32 |= (0x06 << 28);
7005         rtl8xxxu_write32(priv, REG_EFUSE_CTRL, val32);
7006 exit:
7007         return ret;
7008 }
7009
7010 static int rtl8723bu_power_on(struct rtl8xxxu_priv *priv)
7011 {
7012         u8 val8;
7013         u16 val16;
7014         u32 val32;
7015         int ret;
7016
7017         rtl8723a_disabled_to_emu(priv);
7018
7019         ret = rtl8723b_emu_to_active(priv);
7020         if (ret)
7021                 goto exit;
7022
7023         /*
7024          * Enable MAC DMA/WMAC/SCHEDULE/SEC block
7025          * Set CR bit10 to enable 32k calibration.
7026          */
7027         val16 = rtl8xxxu_read16(priv, REG_CR);
7028         val16 |= (CR_HCI_TXDMA_ENABLE | CR_HCI_RXDMA_ENABLE |
7029                   CR_TXDMA_ENABLE | CR_RXDMA_ENABLE |
7030                   CR_PROTOCOL_ENABLE | CR_SCHEDULE_ENABLE |
7031                   CR_MAC_TX_ENABLE | CR_MAC_RX_ENABLE |
7032                   CR_SECURITY_ENABLE | CR_CALTIMER_ENABLE);
7033         rtl8xxxu_write16(priv, REG_CR, val16);
7034
7035         /*
7036          * BT coexist power on settings. This is identical for 1 and 2
7037          * antenna parts.
7038          */
7039         rtl8xxxu_write8(priv, REG_PAD_CTRL1 + 3, 0x20);
7040
7041         val16 = rtl8xxxu_read16(priv, REG_SYS_FUNC);
7042         val16 |= SYS_FUNC_BBRSTB | SYS_FUNC_BB_GLB_RSTN;
7043         rtl8xxxu_write16(priv, REG_SYS_FUNC, val16);
7044
7045         rtl8xxxu_write8(priv, REG_BT_CONTROL_8723BU + 1, 0x18);
7046         rtl8xxxu_write8(priv, REG_WLAN_ACT_CONTROL_8723B, 0x04);
7047         rtl8xxxu_write32(priv, REG_S0S1_PATH_SWITCH, 0x00);
7048         /* Antenna inverse */
7049         rtl8xxxu_write8(priv, 0xfe08, 0x01);
7050
7051         val16 = rtl8xxxu_read16(priv, REG_PWR_DATA);
7052         val16 |= PWR_DATA_EEPRPAD_RFE_CTRL_EN;
7053         rtl8xxxu_write16(priv, REG_PWR_DATA, val16);
7054
7055         val32 = rtl8xxxu_read32(priv, REG_LEDCFG0);
7056         val32 |= LEDCFG0_DPDT_SELECT;
7057         rtl8xxxu_write32(priv, REG_LEDCFG0, val32);
7058
7059         val8 = rtl8xxxu_read8(priv, REG_PAD_CTRL1);
7060         val8 &= ~PAD_CTRL1_SW_DPDT_SEL_DATA;
7061         rtl8xxxu_write8(priv, REG_PAD_CTRL1, val8);
7062 exit:
7063         return ret;
7064 }
7065
7066 #ifdef CONFIG_RTL8XXXU_UNTESTED
7067
7068 static int rtl8192cu_power_on(struct rtl8xxxu_priv *priv)
7069 {
7070         u8 val8;
7071         u16 val16;
7072         u32 val32;
7073         int i;
7074
7075         for (i = 100; i; i--) {
7076                 val8 = rtl8xxxu_read8(priv, REG_APS_FSMCO);
7077                 if (val8 & APS_FSMCO_PFM_ALDN)
7078                         break;
7079         }
7080
7081         if (!i) {
7082                 pr_info("%s: Poll failed\n", __func__);
7083                 return -ENODEV;
7084         }
7085
7086         /*
7087          * RSV_CTRL 0x001C[7:0] = 0x00, unlock ISO/CLK/Power control register
7088          */
7089         rtl8xxxu_write8(priv, REG_RSV_CTRL, 0x0);
7090         rtl8xxxu_write8(priv, REG_SPS0_CTRL, 0x2b);
7091         udelay(100);
7092
7093         val8 = rtl8xxxu_read8(priv, REG_LDOV12D_CTRL);
7094         if (!(val8 & LDOV12D_ENABLE)) {
7095                 pr_info("%s: Enabling LDOV12D (%02x)\n", __func__, val8);
7096                 val8 |= LDOV12D_ENABLE;
7097                 rtl8xxxu_write8(priv, REG_LDOV12D_CTRL, val8);
7098
7099                 udelay(100);
7100
7101                 val8 = rtl8xxxu_read8(priv, REG_SYS_ISO_CTRL);
7102                 val8 &= ~SYS_ISO_MD2PP;
7103                 rtl8xxxu_write8(priv, REG_SYS_ISO_CTRL, val8);
7104         }
7105
7106         /*
7107          * Auto enable WLAN
7108          */
7109         val16 = rtl8xxxu_read16(priv, REG_APS_FSMCO);
7110         val16 |= APS_FSMCO_MAC_ENABLE;
7111         rtl8xxxu_write16(priv, REG_APS_FSMCO, val16);
7112
7113         for (i = 1000; i; i--) {
7114                 val16 = rtl8xxxu_read16(priv, REG_APS_FSMCO);
7115                 if (!(val16 & APS_FSMCO_MAC_ENABLE))
7116                         break;
7117         }
7118         if (!i) {
7119                 pr_info("%s: FSMCO_MAC_ENABLE poll failed\n", __func__);
7120                 return -EBUSY;
7121         }
7122
7123         /*
7124          * Enable radio, GPIO, LED
7125          */
7126         val16 = APS_FSMCO_HW_SUSPEND | APS_FSMCO_ENABLE_POWERDOWN |
7127                 APS_FSMCO_PFM_ALDN;
7128         rtl8xxxu_write16(priv, REG_APS_FSMCO, val16);
7129
7130         /*
7131          * Release RF digital isolation
7132          */
7133         val16 = rtl8xxxu_read16(priv, REG_SYS_ISO_CTRL);
7134         val16 &= ~SYS_ISO_DIOR;
7135         rtl8xxxu_write16(priv, REG_SYS_ISO_CTRL, val16);
7136
7137         val8 = rtl8xxxu_read8(priv, REG_APSD_CTRL);
7138         val8 &= ~APSD_CTRL_OFF;
7139         rtl8xxxu_write8(priv, REG_APSD_CTRL, val8);
7140         for (i = 200; i; i--) {
7141                 val8 = rtl8xxxu_read8(priv, REG_APSD_CTRL);
7142                 if (!(val8 & APSD_CTRL_OFF_STATUS))
7143                         break;
7144         }
7145
7146         if (!i) {
7147                 pr_info("%s: APSD_CTRL poll failed\n", __func__);
7148                 return -EBUSY;
7149         }
7150
7151         /*
7152          * Enable MAC DMA/WMAC/SCHEDULE/SEC block
7153          */
7154         val16 = rtl8xxxu_read16(priv, REG_CR);
7155         val16 |= CR_HCI_TXDMA_ENABLE | CR_HCI_RXDMA_ENABLE |
7156                 CR_TXDMA_ENABLE | CR_RXDMA_ENABLE | CR_PROTOCOL_ENABLE |
7157                 CR_SCHEDULE_ENABLE | CR_MAC_TX_ENABLE | CR_MAC_RX_ENABLE;
7158         rtl8xxxu_write16(priv, REG_CR, val16);
7159
7160         /*
7161          * Workaround for 8188RU LNA power leakage problem.
7162          */
7163         if (priv->rtl_chip == RTL8188C && priv->hi_pa) {
7164                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_XCD_RF_PARM);
7165                 val32 &= ~BIT(1);
7166                 rtl8xxxu_write32(priv, REG_FPGA0_XCD_RF_PARM, val32);
7167         }
7168         return 0;
7169 }
7170
7171 #endif
7172
7173 /*
7174  * This is needed for 8723bu as well, presumable
7175  */
7176 static void rtl8192e_crystal_afe_adjust(struct rtl8xxxu_priv *priv)
7177 {
7178         u8 val8;
7179         u32 val32;
7180
7181         /*
7182          * 40Mhz crystal source, MAC 0x28[2]=0
7183          */
7184         val8 = rtl8xxxu_read8(priv, REG_AFE_PLL_CTRL);
7185         val8 &= 0xfb;
7186         rtl8xxxu_write8(priv, REG_AFE_PLL_CTRL, val8);
7187
7188         val32 = rtl8xxxu_read32(priv, REG_AFE_CTRL4);
7189         val32 &= 0xfffffc7f;
7190         rtl8xxxu_write32(priv, REG_AFE_CTRL4, val32);
7191
7192         /*
7193          * 92e AFE parameter
7194          * AFE PLL KVCO selection, MAC 0x28[6]=1
7195          */
7196         val8 = rtl8xxxu_read8(priv, REG_AFE_PLL_CTRL);
7197         val8 &= 0xbf;
7198         rtl8xxxu_write8(priv, REG_AFE_PLL_CTRL, val8);
7199
7200         /*
7201          * AFE PLL KVCO selection, MAC 0x78[21]=0
7202          */
7203         val32 = rtl8xxxu_read32(priv, REG_AFE_CTRL4);
7204         val32 &= 0xffdfffff;
7205         rtl8xxxu_write32(priv, REG_AFE_CTRL4, val32);
7206 }
7207
7208 static int rtl8192eu_power_on(struct rtl8xxxu_priv *priv)
7209 {
7210         u16 val16;
7211         u32 val32;
7212         int ret;
7213
7214         ret = 0;
7215
7216         val32 = rtl8xxxu_read32(priv, REG_SYS_CFG);
7217         if (val32 & SYS_CFG_SPS_LDO_SEL) {
7218                 rtl8xxxu_write8(priv, REG_LDO_SW_CTRL, 0xc3);
7219         } else {
7220                 /*
7221                  * Raise 1.2V voltage
7222                  */
7223                 val32 = rtl8xxxu_read32(priv, REG_8192E_LDOV12_CTRL);
7224                 val32 &= 0xff0fffff;
7225                 val32 |= 0x00500000;
7226                 rtl8xxxu_write32(priv, REG_8192E_LDOV12_CTRL, val32);
7227                 rtl8xxxu_write8(priv, REG_LDO_SW_CTRL, 0x83);
7228         }
7229
7230         /*
7231          * Adjust AFE before enabling PLL
7232          */
7233         rtl8192e_crystal_afe_adjust(priv);
7234         rtl8192e_disabled_to_emu(priv);
7235
7236         ret = rtl8192e_emu_to_active(priv);
7237         if (ret)
7238                 goto exit;
7239
7240         rtl8xxxu_write16(priv, REG_CR, 0x0000);
7241
7242         /*
7243          * Enable MAC DMA/WMAC/SCHEDULE/SEC block
7244          * Set CR bit10 to enable 32k calibration.
7245          */
7246         val16 = rtl8xxxu_read16(priv, REG_CR);
7247         val16 |= (CR_HCI_TXDMA_ENABLE | CR_HCI_RXDMA_ENABLE |
7248                   CR_TXDMA_ENABLE | CR_RXDMA_ENABLE |
7249                   CR_PROTOCOL_ENABLE | CR_SCHEDULE_ENABLE |
7250                   CR_MAC_TX_ENABLE | CR_MAC_RX_ENABLE |
7251                   CR_SECURITY_ENABLE | CR_CALTIMER_ENABLE);
7252         rtl8xxxu_write16(priv, REG_CR, val16);
7253
7254 exit:
7255         return ret;
7256 }
7257
7258 static void rtl8xxxu_power_off(struct rtl8xxxu_priv *priv)
7259 {
7260         u8 val8;
7261         u16 val16;
7262         u32 val32;
7263
7264         /*
7265          * Workaround for 8188RU LNA power leakage problem.
7266          */
7267         if (priv->rtl_chip == RTL8188C && priv->hi_pa) {
7268                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_XCD_RF_PARM);
7269                 val32 |= BIT(1);
7270                 rtl8xxxu_write32(priv, REG_FPGA0_XCD_RF_PARM, val32);
7271         }
7272
7273         rtl8xxxu_flush_fifo(priv);
7274
7275         rtl8xxxu_active_to_lps(priv);
7276
7277         /* Turn off RF */
7278         rtl8xxxu_write8(priv, REG_RF_CTRL, 0x00);
7279
7280         /* Reset Firmware if running in RAM */
7281         if (rtl8xxxu_read8(priv, REG_MCU_FW_DL) & MCU_FW_RAM_SEL)
7282                 rtl8xxxu_firmware_self_reset(priv);
7283
7284         /* Reset MCU */
7285         val16 = rtl8xxxu_read16(priv, REG_SYS_FUNC);
7286         val16 &= ~SYS_FUNC_CPU_ENABLE;
7287         rtl8xxxu_write16(priv, REG_SYS_FUNC, val16);
7288
7289         /* Reset MCU ready status */
7290         rtl8xxxu_write8(priv, REG_MCU_FW_DL, 0x00);
7291
7292         rtl8xxxu_active_to_emu(priv);
7293         rtl8xxxu_emu_to_disabled(priv);
7294
7295         /* Reset MCU IO Wrapper */
7296         val8 = rtl8xxxu_read8(priv, REG_RSV_CTRL + 1);
7297         val8 &= ~BIT(0);
7298         rtl8xxxu_write8(priv, REG_RSV_CTRL + 1, val8);
7299
7300         val8 = rtl8xxxu_read8(priv, REG_RSV_CTRL + 1);
7301         val8 |= BIT(0);
7302         rtl8xxxu_write8(priv, REG_RSV_CTRL + 1, val8);
7303
7304         /* RSV_CTRL 0x1C[7:0] = 0x0e  lock ISO/CLK/Power control register */
7305         rtl8xxxu_write8(priv, REG_RSV_CTRL, 0x0e);
7306 }
7307
7308 static void rtl8723bu_power_off(struct rtl8xxxu_priv *priv)
7309 {
7310         u8 val8;
7311         u16 val16;
7312
7313         rtl8xxxu_flush_fifo(priv);
7314
7315         /*
7316          * Disable TX report timer
7317          */
7318         val8 = rtl8xxxu_read8(priv, REG_TX_REPORT_CTRL);
7319         val8 &= ~TX_REPORT_CTRL_TIMER_ENABLE;
7320         rtl8xxxu_write8(priv, REG_TX_REPORT_CTRL, val8);
7321
7322         rtl8xxxu_write16(priv, REG_CR, 0x0000);
7323
7324         rtl8xxxu_active_to_lps(priv);
7325
7326         /* Reset Firmware if running in RAM */
7327         if (rtl8xxxu_read8(priv, REG_MCU_FW_DL) & MCU_FW_RAM_SEL)
7328                 rtl8xxxu_firmware_self_reset(priv);
7329
7330         /* Reset MCU */
7331         val16 = rtl8xxxu_read16(priv, REG_SYS_FUNC);
7332         val16 &= ~SYS_FUNC_CPU_ENABLE;
7333         rtl8xxxu_write16(priv, REG_SYS_FUNC, val16);
7334
7335         /* Reset MCU ready status */
7336         rtl8xxxu_write8(priv, REG_MCU_FW_DL, 0x00);
7337
7338         rtl8723bu_active_to_emu(priv);
7339         rtl8xxxu_emu_to_disabled(priv);
7340 }
7341
7342 #ifdef NEED_PS_TDMA
7343 static void rtl8723bu_set_ps_tdma(struct rtl8xxxu_priv *priv,
7344                                   u8 arg1, u8 arg2, u8 arg3, u8 arg4, u8 arg5)
7345 {
7346         struct h2c_cmd h2c;
7347
7348         memset(&h2c, 0, sizeof(struct h2c_cmd));
7349         h2c.b_type_dma.cmd = H2C_8723B_B_TYPE_TDMA;
7350         h2c.b_type_dma.data1 = arg1;
7351         h2c.b_type_dma.data2 = arg2;
7352         h2c.b_type_dma.data3 = arg3;
7353         h2c.b_type_dma.data4 = arg4;
7354         h2c.b_type_dma.data5 = arg5;
7355         rtl8723a_h2c_cmd(priv, &h2c, sizeof(h2c.b_type_dma));
7356 }
7357 #endif
7358
7359 static void rtl8723b_enable_rf(struct rtl8xxxu_priv *priv)
7360 {
7361         struct h2c_cmd h2c;
7362         u32 val32;
7363         u8 val8;
7364
7365         /*
7366          * No indication anywhere as to what 0x0790 does. The 2 antenna
7367          * vendor code preserves bits 6-7 here.
7368          */
7369         rtl8xxxu_write8(priv, 0x0790, 0x05);
7370         /*
7371          * 0x0778 seems to be related to enabling the number of antennas
7372          * In the vendor driver halbtc8723b2ant_InitHwConfig() sets it
7373          * to 0x03, while halbtc8723b1ant_InitHwConfig() sets it to 0x01
7374          */
7375         rtl8xxxu_write8(priv, 0x0778, 0x01);
7376
7377         val8 = rtl8xxxu_read8(priv, REG_GPIO_MUXCFG);
7378         val8 |= BIT(5);
7379         rtl8xxxu_write8(priv, REG_GPIO_MUXCFG, val8);
7380
7381         rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_IQADJ_G1, 0x780);
7382
7383         rtl8723bu_write_btreg(priv, 0x3c, 0x15); /* BT TRx Mask on */
7384
7385         /*
7386          * Set BT grant to low
7387          */
7388         memset(&h2c, 0, sizeof(struct h2c_cmd));
7389         h2c.bt_grant.cmd = H2C_8723B_BT_GRANT;
7390         h2c.bt_grant.data = 0;
7391         rtl8723a_h2c_cmd(priv, &h2c, sizeof(h2c.bt_grant));
7392
7393         /*
7394          * WLAN action by PTA
7395          */
7396         rtl8xxxu_write8(priv, REG_WLAN_ACT_CONTROL_8723B, 0x04);
7397
7398         /*
7399          * BT select S0/S1 controlled by WiFi
7400          */
7401         val8 = rtl8xxxu_read8(priv, 0x0067);
7402         val8 |= BIT(5);
7403         rtl8xxxu_write8(priv, 0x0067, val8);
7404
7405         val32 = rtl8xxxu_read32(priv, REG_PWR_DATA);
7406         val32 |= PWR_DATA_EEPRPAD_RFE_CTRL_EN;
7407         rtl8xxxu_write32(priv, REG_PWR_DATA, val32);
7408
7409         /*
7410          * Bits 6/7 are marked in/out ... but for what?
7411          */
7412         rtl8xxxu_write8(priv, 0x0974, 0xff);
7413
7414         val32 = rtl8xxxu_read32(priv, REG_RFE_BUFFER);
7415         val32 |= (BIT(0) | BIT(1));
7416         rtl8xxxu_write32(priv, REG_RFE_BUFFER, val32);
7417
7418         rtl8xxxu_write8(priv, REG_RFE_CTRL_ANTA_SRC, 0x77);
7419
7420         val32 = rtl8xxxu_read32(priv, REG_LEDCFG0);
7421         val32 &= ~BIT(24);
7422         val32 |= BIT(23);
7423         rtl8xxxu_write32(priv, REG_LEDCFG0, val32);
7424
7425         /*
7426          * Fix external switch Main->S1, Aux->S0
7427          */
7428         val8 = rtl8xxxu_read8(priv, REG_PAD_CTRL1);
7429         val8 &= ~BIT(0);
7430         rtl8xxxu_write8(priv, REG_PAD_CTRL1, val8);
7431
7432         memset(&h2c, 0, sizeof(struct h2c_cmd));
7433         h2c.ant_sel_rsv.cmd = H2C_8723B_ANT_SEL_RSV;
7434         h2c.ant_sel_rsv.ant_inverse = 1;
7435         h2c.ant_sel_rsv.int_switch_type = 0;
7436         rtl8723a_h2c_cmd(priv, &h2c, sizeof(h2c.ant_sel_rsv));
7437
7438         /*
7439          * 0x280, 0x00, 0x200, 0x80 - not clear
7440          */
7441         rtl8xxxu_write32(priv, REG_S0S1_PATH_SWITCH, 0x00);
7442
7443         /*
7444          * Software control, antenna at WiFi side
7445          */
7446 #ifdef NEED_PS_TDMA
7447         rtl8723bu_set_ps_tdma(priv, 0x08, 0x00, 0x00, 0x00, 0x00);
7448 #endif
7449
7450         rtl8xxxu_write32(priv, REG_BT_COEX_TABLE1, 0x55555555);
7451         rtl8xxxu_write32(priv, REG_BT_COEX_TABLE2, 0x55555555);
7452         rtl8xxxu_write32(priv, REG_BT_COEX_TABLE3, 0x00ffffff);
7453         rtl8xxxu_write8(priv, REG_BT_COEX_TABLE4, 0x03);
7454
7455         memset(&h2c, 0, sizeof(struct h2c_cmd));
7456         h2c.bt_info.cmd = H2C_8723B_BT_INFO;
7457         h2c.bt_info.data = BIT(0);
7458         rtl8723a_h2c_cmd(priv, &h2c, sizeof(h2c.bt_info));
7459
7460         memset(&h2c, 0, sizeof(struct h2c_cmd));
7461         h2c.ignore_wlan.cmd = H2C_8723B_BT_IGNORE_WLANACT;
7462         h2c.ignore_wlan.data = 0;
7463         rtl8723a_h2c_cmd(priv, &h2c, sizeof(h2c.ignore_wlan));
7464 }
7465
7466 static void rtl8723b_disable_rf(struct rtl8xxxu_priv *priv)
7467 {
7468         u32 val32;
7469
7470         rtl8xxxu_write8(priv, REG_TXPAUSE, 0xff);
7471
7472         val32 = rtl8xxxu_read32(priv, REG_RX_WAIT_CCA);
7473         val32 &= ~(BIT(22) | BIT(23));
7474         rtl8xxxu_write32(priv, REG_RX_WAIT_CCA, val32);
7475 }
7476
7477 static void rtl8723bu_init_aggregation(struct rtl8xxxu_priv *priv)
7478 {
7479         u32 agg_rx;
7480         u8 agg_ctrl;
7481
7482         /*
7483          * For now simply disable RX aggregation
7484          */
7485         agg_ctrl = rtl8xxxu_read8(priv, REG_TRXDMA_CTRL);
7486         agg_ctrl &= ~TRXDMA_CTRL_RXDMA_AGG_EN;
7487
7488         agg_rx = rtl8xxxu_read32(priv, REG_RXDMA_AGG_PG_TH);
7489         agg_rx &= ~RXDMA_USB_AGG_ENABLE;
7490         agg_rx &= ~0xff0f;
7491
7492         rtl8xxxu_write8(priv, REG_TRXDMA_CTRL, agg_ctrl);
7493         rtl8xxxu_write32(priv, REG_RXDMA_AGG_PG_TH, agg_rx);
7494 }
7495
7496 static void rtl8723bu_init_statistics(struct rtl8xxxu_priv *priv)
7497 {
7498         u32 val32;
7499
7500         /* Time duration for NHM unit: 4us, 0x2710=40ms */
7501         rtl8xxxu_write16(priv, REG_NHM_TIMER_8723B + 2, 0x2710);
7502         rtl8xxxu_write16(priv, REG_NHM_TH9_TH10_8723B + 2, 0xffff);
7503         rtl8xxxu_write32(priv, REG_NHM_TH3_TO_TH0_8723B, 0xffffff52);
7504         rtl8xxxu_write32(priv, REG_NHM_TH7_TO_TH4_8723B, 0xffffffff);
7505         /* TH8 */
7506         val32 = rtl8xxxu_read32(priv, REG_FPGA0_IQK);
7507         val32 |= 0xff;
7508         rtl8xxxu_write32(priv, REG_FPGA0_IQK, val32);
7509         /* Enable CCK */
7510         val32 = rtl8xxxu_read32(priv, REG_NHM_TH9_TH10_8723B);
7511         val32 |= BIT(8) | BIT(9) | BIT(10);
7512         rtl8xxxu_write32(priv, REG_NHM_TH9_TH10_8723B, val32);
7513         /* Max power amongst all RX antennas */
7514         val32 = rtl8xxxu_read32(priv, REG_OFDM0_FA_RSTC);
7515         val32 |= BIT(7);
7516         rtl8xxxu_write32(priv, REG_OFDM0_FA_RSTC, val32);
7517 }
7518
7519 static void rtl8xxxu_old_init_queue_reserved_page(struct rtl8xxxu_priv *priv)
7520 {
7521         u8 val8;
7522         u32 val32;
7523
7524         if (priv->ep_tx_normal_queue)
7525                 val8 = TX_PAGE_NUM_NORM_PQ;
7526         else
7527                 val8 = 0;
7528
7529         rtl8xxxu_write8(priv, REG_RQPN_NPQ, val8);
7530
7531         val32 = (TX_PAGE_NUM_PUBQ << RQPN_PUB_PQ_SHIFT) | RQPN_LOAD;
7532
7533         if (priv->ep_tx_high_queue)
7534                 val32 |= (TX_PAGE_NUM_HI_PQ << RQPN_HI_PQ_SHIFT);
7535         if (priv->ep_tx_low_queue)
7536                 val32 |= (TX_PAGE_NUM_LO_PQ << RQPN_LO_PQ_SHIFT);
7537
7538         rtl8xxxu_write32(priv, REG_RQPN, val32);
7539 }
7540
7541 static void rtl8xxxu_init_queue_reserved_page(struct rtl8xxxu_priv *priv)
7542 {
7543         struct rtl8xxxu_fileops *fops = priv->fops;
7544         u32 hq, lq, nq, eq, pubq;
7545         u32 val32;
7546
7547         hq = 0;
7548         lq = 0;
7549         nq = 0;
7550         eq = 0;
7551         pubq = 0;
7552
7553         if (priv->ep_tx_high_queue)
7554                 hq = fops->page_num_hi;
7555         if (priv->ep_tx_low_queue)
7556                 lq = fops->page_num_lo;
7557         if (priv->ep_tx_normal_queue)
7558                 nq = fops->page_num_norm;
7559
7560         val32 = (nq << RQPN_NPQ_SHIFT) | (eq << RQPN_EPQ_SHIFT);
7561         rtl8xxxu_write32(priv, REG_RQPN_NPQ, val32);
7562
7563         pubq = fops->total_page_num - hq - lq - nq;
7564
7565         val32 = RQPN_LOAD;
7566         val32 |= (hq << RQPN_HI_PQ_SHIFT);
7567         val32 |= (lq << RQPN_LO_PQ_SHIFT);
7568         val32 |= (pubq << RQPN_PUB_PQ_SHIFT);
7569
7570         rtl8xxxu_write32(priv, REG_RQPN, val32);
7571 }
7572
7573 static int rtl8xxxu_init_device(struct ieee80211_hw *hw)
7574 {
7575         struct rtl8xxxu_priv *priv = hw->priv;
7576         struct device *dev = &priv->udev->dev;
7577         struct rtl8xxxu_rfregval *rftable;
7578         bool macpower;
7579         int ret;
7580         u8 val8;
7581         u16 val16;
7582         u32 val32;
7583
7584         /* Check if MAC is already powered on */
7585         val8 = rtl8xxxu_read8(priv, REG_CR);
7586
7587         /*
7588          * Fix 92DU-VC S3 hang with the reason is that secondary mac is not
7589          * initialized. First MAC returns 0xea, second MAC returns 0x00
7590          */
7591         if (val8 == 0xea)
7592                 macpower = false;
7593         else
7594                 macpower = true;
7595
7596         ret = priv->fops->power_on(priv);
7597         if (ret < 0) {
7598                 dev_warn(dev, "%s: Failed power on\n", __func__);
7599                 goto exit;
7600         }
7601
7602         if (!macpower) {
7603                 if (priv->fops->total_page_num)
7604                         rtl8xxxu_init_queue_reserved_page(priv);
7605                 else
7606                         rtl8xxxu_old_init_queue_reserved_page(priv);
7607         }
7608
7609         ret = rtl8xxxu_init_queue_priority(priv);
7610         dev_dbg(dev, "%s: init_queue_priority %i\n", __func__, ret);
7611         if (ret)
7612                 goto exit;
7613
7614         /*
7615          * Set RX page boundary
7616          */
7617         if (priv->rtl_chip == RTL8723B)
7618                 rtl8xxxu_write16(priv, REG_TRXFF_BNDY + 2, 0x3f7f);
7619         else if (priv->rtl_chip == RTL8192E)
7620                 rtl8xxxu_write16(priv, REG_TRXFF_BNDY + 2, 0x3cff);
7621         else
7622                 rtl8xxxu_write16(priv, REG_TRXFF_BNDY + 2, 0x27ff);
7623
7624         ret = rtl8xxxu_download_firmware(priv);
7625         dev_dbg(dev, "%s: download_fiwmare %i\n", __func__, ret);
7626         if (ret)
7627                 goto exit;
7628         ret = rtl8xxxu_start_firmware(priv);
7629         dev_dbg(dev, "%s: start_fiwmare %i\n", __func__, ret);
7630         if (ret)
7631                 goto exit;
7632
7633         /* Solve too many protocol error on USB bus */
7634         /* Can't do this for 8188/8192 UMC A cut parts */
7635         if (priv->rtl_chip == RTL8723A ||
7636             ((priv->rtl_chip == RTL8192C || priv->rtl_chip == RTL8191C ||
7637               priv->rtl_chip == RTL8188C) &&
7638              (priv->chip_cut || !priv->vendor_umc))) {
7639                 rtl8xxxu_write8(priv, 0xfe40, 0xe6);
7640                 rtl8xxxu_write8(priv, 0xfe41, 0x94);
7641                 rtl8xxxu_write8(priv, 0xfe42, 0x80);
7642
7643                 rtl8xxxu_write8(priv, 0xfe40, 0xe0);
7644                 rtl8xxxu_write8(priv, 0xfe41, 0x19);
7645                 rtl8xxxu_write8(priv, 0xfe42, 0x80);
7646
7647                 rtl8xxxu_write8(priv, 0xfe40, 0xe5);
7648                 rtl8xxxu_write8(priv, 0xfe41, 0x91);
7649                 rtl8xxxu_write8(priv, 0xfe42, 0x80);
7650
7651                 rtl8xxxu_write8(priv, 0xfe40, 0xe2);
7652                 rtl8xxxu_write8(priv, 0xfe41, 0x81);
7653                 rtl8xxxu_write8(priv, 0xfe42, 0x80);
7654         }
7655
7656         if (priv->fops->phy_init_antenna_selection)
7657                 priv->fops->phy_init_antenna_selection(priv);
7658
7659         ret = rtl8xxxu_init_mac(priv);
7660
7661         dev_dbg(dev, "%s: init_mac %i\n", __func__, ret);
7662         if (ret)
7663                 goto exit;
7664
7665         ret = rtl8xxxu_init_phy_bb(priv);
7666         dev_dbg(dev, "%s: init_phy_bb %i\n", __func__, ret);
7667         if (ret)
7668                 goto exit;
7669
7670         switch(priv->rtl_chip) {
7671         case RTL8723A:
7672                 rftable = rtl8723au_radioa_1t_init_table;
7673                 ret = rtl8xxxu_init_phy_rf(priv, rftable, RF_A);
7674                 break;
7675         case RTL8723B:
7676                 rftable = rtl8723bu_radioa_1t_init_table;
7677                 ret = rtl8xxxu_init_phy_rf(priv, rftable, RF_A);
7678                 /*
7679                  * PHY LCK
7680                  */
7681                 rtl8xxxu_write_rfreg(priv, RF_A, 0xb0, 0xdfbe0);
7682                 rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_MODE_AG, 0x8c01);
7683                 msleep(200);
7684                 rtl8xxxu_write_rfreg(priv, RF_A, 0xb0, 0xdffe0);
7685                 break;
7686         case RTL8188C:
7687                 if (priv->hi_pa)
7688                         rftable = rtl8188ru_radioa_1t_highpa_table;
7689                 else
7690                         rftable = rtl8192cu_radioa_1t_init_table;
7691                 ret = rtl8xxxu_init_phy_rf(priv, rftable, RF_A);
7692                 break;
7693         case RTL8191C:
7694                 rftable = rtl8192cu_radioa_1t_init_table;
7695                 ret = rtl8xxxu_init_phy_rf(priv, rftable, RF_A);
7696                 break;
7697         case RTL8192C:
7698                 rftable = rtl8192cu_radioa_2t_init_table;
7699                 ret = rtl8xxxu_init_phy_rf(priv, rftable, RF_A);
7700                 if (ret)
7701                         break;
7702                 rftable = rtl8192cu_radiob_2t_init_table;
7703                 ret = rtl8xxxu_init_phy_rf(priv, rftable, RF_B);
7704                 break;
7705         case RTL8192E:
7706                 rftable = rtl8192eu_radioa_init_table;
7707                 ret = rtl8xxxu_init_phy_rf(priv, rftable, RF_A);
7708                 if (ret)
7709                         break;
7710                 rftable = rtl8192eu_radiob_init_table;
7711                 ret = rtl8xxxu_init_phy_rf(priv, rftable, RF_B);
7712                 break;
7713         default:
7714                 ret = -EINVAL;
7715         }
7716
7717         if (ret)
7718                 goto exit;
7719
7720         /* RFSW Control - clear bit 14 ?? */
7721         if (priv->rtl_chip != RTL8723B && priv->rtl_chip != RTL8192E)
7722                 rtl8xxxu_write32(priv, REG_FPGA0_TX_INFO, 0x00000003);
7723         /* 0x07000760 */
7724         if (priv->rtl_chip == RTL8192E) {
7725                 val32 = 0;
7726         } else {
7727                 val32 = FPGA0_RF_TRSW | FPGA0_RF_TRSWB | FPGA0_RF_ANTSW |
7728                         FPGA0_RF_ANTSWB | FPGA0_RF_PAPE |
7729                         ((FPGA0_RF_ANTSW | FPGA0_RF_ANTSWB | FPGA0_RF_PAPE) <<
7730                          FPGA0_RF_BD_CTRL_SHIFT);
7731         }
7732         rtl8xxxu_write32(priv, REG_FPGA0_XAB_RF_SW_CTRL, val32);
7733         /* 0x860[6:5]= 00 - why? - this sets antenna B */
7734         if (priv->rtl_chip != RTL8192E)
7735                 rtl8xxxu_write32(priv, REG_FPGA0_XA_RF_INT_OE, 0x66f60210);
7736
7737         priv->rf_mode_ag[0] = rtl8xxxu_read_rfreg(priv, RF_A,
7738                                                   RF6052_REG_MODE_AG);
7739
7740         if (!macpower) {
7741                 /*
7742                  * Set TX buffer boundary
7743                  */
7744                 if (priv->rtl_chip == RTL8192E)
7745                         val8 = TX_TOTAL_PAGE_NUM_8192E + 1;
7746                 else
7747                         val8 = TX_TOTAL_PAGE_NUM + 1;
7748
7749                 if (priv->rtl_chip == RTL8723B)
7750                         val8 -= 1;
7751
7752                 rtl8xxxu_write8(priv, REG_TXPKTBUF_BCNQ_BDNY, val8);
7753                 rtl8xxxu_write8(priv, REG_TXPKTBUF_MGQ_BDNY, val8);
7754                 rtl8xxxu_write8(priv, REG_TXPKTBUF_WMAC_LBK_BF_HD, val8);
7755                 rtl8xxxu_write8(priv, REG_TRXFF_BNDY, val8);
7756                 rtl8xxxu_write8(priv, REG_TDECTRL + 1, val8);
7757         }
7758
7759         /*
7760          * Transfer page size is always 128
7761          */
7762         if (priv->rtl_chip == RTL8723B)
7763                 val8 = (PBP_PAGE_SIZE_256 << PBP_PAGE_SIZE_RX_SHIFT) |
7764                         (PBP_PAGE_SIZE_256 << PBP_PAGE_SIZE_TX_SHIFT);
7765         else
7766                 val8 = (PBP_PAGE_SIZE_128 << PBP_PAGE_SIZE_RX_SHIFT) |
7767                         (PBP_PAGE_SIZE_128 << PBP_PAGE_SIZE_TX_SHIFT);
7768         if (priv->rtl_chip != RTL8192E)
7769                 rtl8xxxu_write8(priv, REG_PBP, val8);
7770
7771         dev_dbg(dev, "%s: macpower %i\n", __func__, macpower);
7772         if (!macpower) {
7773                 ret = priv->fops->llt_init(priv, TX_TOTAL_PAGE_NUM);
7774                 if (ret) {
7775                         dev_warn(dev, "%s: LLT table init failed\n", __func__);
7776                         goto exit;
7777                 }
7778
7779                 /*
7780                  * Chip specific quirks
7781                  */
7782                 if (priv->rtl_chip == RTL8723A) {
7783                         /* Fix USB interface interference issue */
7784                         rtl8xxxu_write8(priv, 0xfe40, 0xe0);
7785                         rtl8xxxu_write8(priv, 0xfe41, 0x8d);
7786                         rtl8xxxu_write8(priv, 0xfe42, 0x80);
7787                         rtl8xxxu_write32(priv, REG_TXDMA_OFFSET_CHK, 0xfd0320);
7788
7789                         /* Reduce 80M spur */
7790                         rtl8xxxu_write32(priv, REG_AFE_XTAL_CTRL, 0x0381808d);
7791                         rtl8xxxu_write32(priv, REG_AFE_PLL_CTRL, 0xf0ffff83);
7792                         rtl8xxxu_write32(priv, REG_AFE_PLL_CTRL, 0xf0ffff82);
7793                         rtl8xxxu_write32(priv, REG_AFE_PLL_CTRL, 0xf0ffff83);
7794                 } else {
7795                         val32 = rtl8xxxu_read32(priv, REG_TXDMA_OFFSET_CHK);
7796                         val32 |= TXDMA_OFFSET_DROP_DATA_EN;
7797                         rtl8xxxu_write32(priv, REG_TXDMA_OFFSET_CHK, val32);
7798                 }
7799
7800                 /*
7801                  * Presumably this is for 8188EU as well
7802                  * Enable TX report and TX report timer
7803                  */
7804                 if (priv->rtl_chip == RTL8723B) {
7805                         val8 = rtl8xxxu_read8(priv, REG_TX_REPORT_CTRL);
7806                         val8 |= TX_REPORT_CTRL_TIMER_ENABLE;
7807                         rtl8xxxu_write8(priv, REG_TX_REPORT_CTRL, val8);
7808                         /* Set MAX RPT MACID */
7809                         rtl8xxxu_write8(priv, REG_TX_REPORT_CTRL + 1, 0x02);
7810                         /* TX report Timer. Unit: 32us */
7811                         rtl8xxxu_write16(priv, REG_TX_REPORT_TIME, 0xcdf0);
7812
7813                         /* tmp ps ? */
7814                         val8 = rtl8xxxu_read8(priv, 0xa3);
7815                         val8 &= 0xf8;
7816                         rtl8xxxu_write8(priv, 0xa3, val8);
7817                 }
7818         }
7819
7820         /*
7821          * Unit in 8 bytes, not obvious what it is used for
7822          */
7823         rtl8xxxu_write8(priv, REG_RX_DRVINFO_SZ, 4);
7824
7825         if (priv->rtl_chip == RTL8192E) {
7826                 rtl8xxxu_write32(priv, REG_HIMR0, 0x00);
7827                 rtl8xxxu_write32(priv, REG_HIMR1, 0x00);
7828         } else {
7829                 /*
7830                  * Enable all interrupts - not obvious USB needs to do this
7831                  */
7832                 rtl8xxxu_write32(priv, REG_HISR, 0xffffffff);
7833                 rtl8xxxu_write32(priv, REG_HIMR, 0xffffffff);
7834         }
7835
7836         rtl8xxxu_set_mac(priv);
7837         rtl8xxxu_set_linktype(priv, NL80211_IFTYPE_STATION);
7838
7839         /*
7840          * Configure initial WMAC settings
7841          */
7842         val32 = RCR_ACCEPT_PHYS_MATCH | RCR_ACCEPT_MCAST | RCR_ACCEPT_BCAST |
7843                 RCR_ACCEPT_MGMT_FRAME | RCR_HTC_LOC_CTRL |
7844                 RCR_APPEND_PHYSTAT | RCR_APPEND_ICV | RCR_APPEND_MIC;
7845         rtl8xxxu_write32(priv, REG_RCR, val32);
7846
7847         /*
7848          * Accept all multicast
7849          */
7850         rtl8xxxu_write32(priv, REG_MAR, 0xffffffff);
7851         rtl8xxxu_write32(priv, REG_MAR + 4, 0xffffffff);
7852
7853         /*
7854          * Init adaptive controls
7855          */
7856         val32 = rtl8xxxu_read32(priv, REG_RESPONSE_RATE_SET);
7857         val32 &= ~RESPONSE_RATE_BITMAP_ALL;
7858         val32 |= RESPONSE_RATE_RRSR_CCK_ONLY_1M;
7859         rtl8xxxu_write32(priv, REG_RESPONSE_RATE_SET, val32);
7860
7861         /* CCK = 0x0a, OFDM = 0x10 */
7862         rtl8xxxu_set_spec_sifs(priv, 0x10, 0x10);
7863         rtl8xxxu_set_retry(priv, 0x30, 0x30);
7864         rtl8xxxu_set_spec_sifs(priv, 0x0a, 0x10);
7865
7866         /*
7867          * Init EDCA
7868          */
7869         rtl8xxxu_write16(priv, REG_MAC_SPEC_SIFS, 0x100a);
7870
7871         /* Set CCK SIFS */
7872         rtl8xxxu_write16(priv, REG_SIFS_CCK, 0x100a);
7873
7874         /* Set OFDM SIFS */
7875         rtl8xxxu_write16(priv, REG_SIFS_OFDM, 0x100a);
7876
7877         /* TXOP */
7878         rtl8xxxu_write32(priv, REG_EDCA_BE_PARAM, 0x005ea42b);
7879         rtl8xxxu_write32(priv, REG_EDCA_BK_PARAM, 0x0000a44f);
7880         rtl8xxxu_write32(priv, REG_EDCA_VI_PARAM, 0x005ea324);
7881         rtl8xxxu_write32(priv, REG_EDCA_VO_PARAM, 0x002fa226);
7882
7883         /* Set data auto rate fallback retry count */
7884         rtl8xxxu_write32(priv, REG_DARFRC, 0x00000000);
7885         rtl8xxxu_write32(priv, REG_DARFRC + 4, 0x10080404);
7886         rtl8xxxu_write32(priv, REG_RARFRC, 0x04030201);
7887         rtl8xxxu_write32(priv, REG_RARFRC + 4, 0x08070605);
7888
7889         val8 = rtl8xxxu_read8(priv, REG_FWHW_TXQ_CTRL);
7890         val8 |= FWHW_TXQ_CTRL_AMPDU_RETRY;
7891         rtl8xxxu_write8(priv, REG_FWHW_TXQ_CTRL, val8);
7892
7893         /*  Set ACK timeout */
7894         rtl8xxxu_write8(priv, REG_ACKTO, 0x40);
7895
7896         /*
7897          * Initialize beacon parameters
7898          */
7899         val16 = BEACON_DISABLE_TSF_UPDATE | (BEACON_DISABLE_TSF_UPDATE << 8);
7900         rtl8xxxu_write16(priv, REG_BEACON_CTRL, val16);
7901         rtl8xxxu_write16(priv, REG_TBTT_PROHIBIT, 0x6404);
7902         rtl8xxxu_write8(priv, REG_DRIVER_EARLY_INT, DRIVER_EARLY_INT_TIME);
7903         rtl8xxxu_write8(priv, REG_BEACON_DMA_TIME, BEACON_DMA_ATIME_INT_TIME);
7904         rtl8xxxu_write16(priv, REG_BEACON_TCFG, 0x660F);
7905
7906         /*
7907          * Initialize burst parameters
7908          */
7909         if (priv->rtl_chip == RTL8723B) {
7910                 /*
7911                  * For USB high speed set 512B packets
7912                  */
7913                 val8 = rtl8xxxu_read8(priv, REG_RXDMA_PRO_8723B);
7914                 val8 &= ~(BIT(4) | BIT(5));
7915                 val8 |= BIT(4);
7916                 val8 |= BIT(1) | BIT(2) | BIT(3);
7917                 rtl8xxxu_write8(priv, REG_RXDMA_PRO_8723B, val8);
7918
7919                 /*
7920                  * For USB high speed set 512B packets
7921                  */
7922                 val8 = rtl8xxxu_read8(priv, REG_HT_SINGLE_AMPDU_8723B);
7923                 val8 |= BIT(7);
7924                 rtl8xxxu_write8(priv, REG_HT_SINGLE_AMPDU_8723B, val8);
7925
7926                 rtl8xxxu_write16(priv, REG_MAX_AGGR_NUM, 0x0c14);
7927                 rtl8xxxu_write8(priv, REG_AMPDU_MAX_TIME_8723B, 0x5e);
7928                 rtl8xxxu_write32(priv, REG_AGGLEN_LMT, 0xffffffff);
7929                 rtl8xxxu_write8(priv, REG_RX_PKT_LIMIT, 0x18);
7930                 rtl8xxxu_write8(priv, REG_PIFS, 0x00);
7931                 rtl8xxxu_write8(priv, REG_USTIME_TSF_8723B, 0x50);
7932                 rtl8xxxu_write8(priv, REG_USTIME_EDCA, 0x50);
7933
7934                 val8 = rtl8xxxu_read8(priv, REG_RSV_CTRL);
7935                 val8 |= BIT(5) | BIT(6);
7936                 rtl8xxxu_write8(priv, REG_RSV_CTRL, val8);
7937         }
7938
7939         if (priv->fops->init_aggregation)
7940                 priv->fops->init_aggregation(priv);
7941
7942         /*
7943          * Enable CCK and OFDM block
7944          */
7945         val32 = rtl8xxxu_read32(priv, REG_FPGA0_RF_MODE);
7946         val32 |= (FPGA_RF_MODE_CCK | FPGA_RF_MODE_OFDM);
7947         rtl8xxxu_write32(priv, REG_FPGA0_RF_MODE, val32);
7948
7949         /*
7950          * Invalidate all CAM entries - bit 30 is undocumented
7951          */
7952         rtl8xxxu_write32(priv, REG_CAM_CMD, CAM_CMD_POLLING | BIT(30));
7953
7954         /*
7955          * Start out with default power levels for channel 6, 20MHz
7956          */
7957         priv->fops->set_tx_power(priv, 1, false);
7958
7959         /* Let the 8051 take control of antenna setting */
7960         if (priv->rtl_chip != RTL8192E) {
7961                 val8 = rtl8xxxu_read8(priv, REG_LEDCFG2);
7962                 val8 |= LEDCFG2_DPDT_SELECT;
7963                 rtl8xxxu_write8(priv, REG_LEDCFG2, val8);
7964         }
7965
7966         rtl8xxxu_write8(priv, REG_HWSEQ_CTRL, 0xff);
7967
7968         /* Disable BAR - not sure if this has any effect on USB */
7969         rtl8xxxu_write32(priv, REG_BAR_MODE_CTRL, 0x0201ffff);
7970
7971         rtl8xxxu_write16(priv, REG_FAST_EDCA_CTRL, 0);
7972
7973         if (priv->fops->init_statistics)
7974                 priv->fops->init_statistics(priv);
7975
7976         if (priv->rtl_chip == RTL8192E) {
7977                 /*
7978                  * 0x4c6[3] 1: RTS BW = Data BW
7979                  * 0: RTS BW depends on CCA / secondary CCA result.
7980                  */
7981                 val8 = rtl8xxxu_read8(priv, REG_QUEUE_CTRL);
7982                 val8 &= ~BIT(3);
7983                 rtl8xxxu_write8(priv, REG_QUEUE_CTRL, val8);
7984                 /*
7985                  * Reset USB mode switch setting
7986                  */
7987                 rtl8xxxu_write8(priv, REG_ACLK_MON, 0x00);
7988         }
7989
7990         rtl8723a_phy_lc_calibrate(priv);
7991
7992         priv->fops->phy_iq_calibrate(priv);
7993
7994         /*
7995          * This should enable thermal meter
7996          */
7997         if (priv->fops->tx_desc_size == sizeof(struct rtl8xxxu_txdesc40))
7998                 rtl8xxxu_write_rfreg(priv,
7999                                      RF_A, RF6052_REG_T_METER_8723B, 0x37cf8);
8000         else
8001                 rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_T_METER, 0x60);
8002
8003         /* Set NAV_UPPER to 30000us */
8004         val8 = ((30000 + NAV_UPPER_UNIT - 1) / NAV_UPPER_UNIT);
8005         rtl8xxxu_write8(priv, REG_NAV_UPPER, val8);
8006
8007         if (priv->rtl_chip == RTL8723A) {
8008                 /*
8009                  * 2011/03/09 MH debug only, UMC-B cut pass 2500 S5 test,
8010                  * but we need to find root cause.
8011                  * This is 8723au only.
8012                  */
8013                 val32 = rtl8xxxu_read32(priv, REG_FPGA0_RF_MODE);
8014                 if ((val32 & 0xff000000) != 0x83000000) {
8015                         val32 |= FPGA_RF_MODE_CCK;
8016                         rtl8xxxu_write32(priv, REG_FPGA0_RF_MODE, val32);
8017                 }
8018         } else if (priv->rtl_chip == RTL8192E) {
8019                 rtl8xxxu_write8(priv, REG_USB_HRPWM, 0x00);
8020         }
8021
8022         val32 = rtl8xxxu_read32(priv, REG_FWHW_TXQ_CTRL);
8023         val32 |= FWHW_TXQ_CTRL_XMIT_MGMT_ACK;
8024         /* ack for xmit mgmt frames. */
8025         rtl8xxxu_write32(priv, REG_FWHW_TXQ_CTRL, val32);
8026
8027         if (priv->rtl_chip == RTL8192E) {
8028                 /*
8029                  * Fix LDPC rx hang issue.
8030                  */
8031                 val32 = rtl8xxxu_read32(priv, REG_AFE_MISC);
8032                 rtl8xxxu_write8(priv, REG_8192E_LDOV12_CTRL, 0x75);
8033                 val32 &= 0xfff00fff;
8034                 val32 |= 0x0007e000;
8035                 rtl8xxxu_write32(priv, REG_8192E_LDOV12_CTRL, val32);
8036         }
8037 exit:
8038         return ret;
8039 }
8040
8041 static void rtl8xxxu_disable_device(struct ieee80211_hw *hw)
8042 {
8043         struct rtl8xxxu_priv *priv = hw->priv;
8044
8045         priv->fops->power_off(priv);
8046 }
8047
8048 static void rtl8xxxu_cam_write(struct rtl8xxxu_priv *priv,
8049                                struct ieee80211_key_conf *key, const u8 *mac)
8050 {
8051         u32 cmd, val32, addr, ctrl;
8052         int j, i, tmp_debug;
8053
8054         tmp_debug = rtl8xxxu_debug;
8055         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_KEY)
8056                 rtl8xxxu_debug |= RTL8XXXU_DEBUG_REG_WRITE;
8057
8058         /*
8059          * This is a bit of a hack - the lower bits of the cipher
8060          * suite selector happens to match the cipher index in the CAM
8061          */
8062         addr = key->keyidx << CAM_CMD_KEY_SHIFT;
8063         ctrl = (key->cipher & 0x0f) << 2 | key->keyidx | CAM_WRITE_VALID;
8064
8065         for (j = 5; j >= 0; j--) {
8066                 switch (j) {
8067                 case 0:
8068                         val32 = ctrl | (mac[0] << 16) | (mac[1] << 24);
8069                         break;
8070                 case 1:
8071                         val32 = mac[2] | (mac[3] << 8) |
8072                                 (mac[4] << 16) | (mac[5] << 24);
8073                         break;
8074                 default:
8075                         i = (j - 2) << 2;
8076                         val32 = key->key[i] | (key->key[i + 1] << 8) |
8077                                 key->key[i + 2] << 16 | key->key[i + 3] << 24;
8078                         break;
8079                 }
8080
8081                 rtl8xxxu_write32(priv, REG_CAM_WRITE, val32);
8082                 cmd = CAM_CMD_POLLING | CAM_CMD_WRITE | (addr + j);
8083                 rtl8xxxu_write32(priv, REG_CAM_CMD, cmd);
8084                 udelay(100);
8085         }
8086
8087         rtl8xxxu_debug = tmp_debug;
8088 }
8089
8090 static void rtl8xxxu_sw_scan_start(struct ieee80211_hw *hw,
8091                                    struct ieee80211_vif *vif, const u8 *mac)
8092 {
8093         struct rtl8xxxu_priv *priv = hw->priv;
8094         u8 val8;
8095
8096         val8 = rtl8xxxu_read8(priv, REG_BEACON_CTRL);
8097         val8 |= BEACON_DISABLE_TSF_UPDATE;
8098         rtl8xxxu_write8(priv, REG_BEACON_CTRL, val8);
8099 }
8100
8101 static void rtl8xxxu_sw_scan_complete(struct ieee80211_hw *hw,
8102                                       struct ieee80211_vif *vif)
8103 {
8104         struct rtl8xxxu_priv *priv = hw->priv;
8105         u8 val8;
8106
8107         val8 = rtl8xxxu_read8(priv, REG_BEACON_CTRL);
8108         val8 &= ~BEACON_DISABLE_TSF_UPDATE;
8109         rtl8xxxu_write8(priv, REG_BEACON_CTRL, val8);
8110 }
8111
8112 static void rtl8723au_update_rate_mask(struct rtl8xxxu_priv *priv,
8113                                        u32 ramask, int sgi)
8114 {
8115         struct h2c_cmd h2c;
8116
8117         memset(&h2c, 0, sizeof(struct h2c_cmd));
8118
8119         h2c.ramask.cmd = H2C_SET_RATE_MASK;
8120         h2c.ramask.mask_lo = cpu_to_le16(ramask & 0xffff);
8121         h2c.ramask.mask_hi = cpu_to_le16(ramask >> 16);
8122
8123         h2c.ramask.arg = 0x80;
8124         if (sgi)
8125                 h2c.ramask.arg |= 0x20;
8126
8127         dev_dbg(&priv->udev->dev, "%s: rate mask %08x, arg %02x, size %zi\n",
8128                 __func__, ramask, h2c.ramask.arg, sizeof(h2c.ramask));
8129         rtl8723a_h2c_cmd(priv, &h2c, sizeof(h2c.ramask));
8130 }
8131
8132 static void rtl8723bu_update_rate_mask(struct rtl8xxxu_priv *priv,
8133                                        u32 ramask, int sgi)
8134 {
8135         struct h2c_cmd h2c;
8136         u8 bw = 0;
8137
8138         memset(&h2c, 0, sizeof(struct h2c_cmd));
8139
8140         h2c.b_macid_cfg.cmd = H2C_8723B_MACID_CFG_RAID;
8141         h2c.b_macid_cfg.ramask0 = ramask & 0xff;
8142         h2c.b_macid_cfg.ramask1 = (ramask >> 8) & 0xff;
8143         h2c.b_macid_cfg.ramask2 = (ramask >> 16) & 0xff;
8144         h2c.b_macid_cfg.ramask3 = (ramask >> 24) & 0xff;
8145
8146         h2c.ramask.arg = 0x80;
8147         h2c.b_macid_cfg.data1 = 0;
8148         if (sgi)
8149                 h2c.b_macid_cfg.data1 |= BIT(7);
8150
8151         h2c.b_macid_cfg.data2 = bw;
8152
8153         dev_dbg(&priv->udev->dev, "%s: rate mask %08x, arg %02x, size %zi\n",
8154                 __func__, ramask, h2c.ramask.arg, sizeof(h2c.b_macid_cfg));
8155         rtl8723a_h2c_cmd(priv, &h2c, sizeof(h2c.b_macid_cfg));
8156 }
8157
8158 static void rtl8723au_report_connect(struct rtl8xxxu_priv *priv,
8159                                      u8 macid, bool connect)
8160 {
8161         struct h2c_cmd h2c;
8162
8163         memset(&h2c, 0, sizeof(struct h2c_cmd));
8164
8165         h2c.joinbss.cmd = H2C_JOIN_BSS_REPORT;
8166
8167         if (connect)
8168                 h2c.joinbss.data = H2C_JOIN_BSS_CONNECT;
8169         else
8170                 h2c.joinbss.data = H2C_JOIN_BSS_DISCONNECT;
8171
8172         rtl8723a_h2c_cmd(priv, &h2c, sizeof(h2c.joinbss));
8173 }
8174
8175 static void rtl8723bu_report_connect(struct rtl8xxxu_priv *priv,
8176                                      u8 macid, bool connect)
8177 {
8178         struct h2c_cmd h2c;
8179
8180         memset(&h2c, 0, sizeof(struct h2c_cmd));
8181
8182         h2c.media_status_rpt.cmd = H2C_8723B_MEDIA_STATUS_RPT;
8183         if (connect)
8184                 h2c.media_status_rpt.parm |= BIT(0);
8185         else
8186                 h2c.media_status_rpt.parm &= ~BIT(0);
8187
8188         rtl8723a_h2c_cmd(priv, &h2c, sizeof(h2c.media_status_rpt));
8189 }
8190
8191 static void rtl8xxxu_set_basic_rates(struct rtl8xxxu_priv *priv, u32 rate_cfg)
8192 {
8193         u32 val32;
8194         u8 rate_idx = 0;
8195
8196         rate_cfg &= RESPONSE_RATE_BITMAP_ALL;
8197
8198         val32 = rtl8xxxu_read32(priv, REG_RESPONSE_RATE_SET);
8199         val32 &= ~RESPONSE_RATE_BITMAP_ALL;
8200         val32 |= rate_cfg;
8201         rtl8xxxu_write32(priv, REG_RESPONSE_RATE_SET, val32);
8202
8203         dev_dbg(&priv->udev->dev, "%s: rates %08x\n", __func__, rate_cfg);
8204
8205         while (rate_cfg) {
8206                 rate_cfg = (rate_cfg >> 1);
8207                 rate_idx++;
8208         }
8209         rtl8xxxu_write8(priv, REG_INIRTS_RATE_SEL, rate_idx);
8210 }
8211
8212 static void
8213 rtl8xxxu_bss_info_changed(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
8214                           struct ieee80211_bss_conf *bss_conf, u32 changed)
8215 {
8216         struct rtl8xxxu_priv *priv = hw->priv;
8217         struct device *dev = &priv->udev->dev;
8218         struct ieee80211_sta *sta;
8219         u32 val32;
8220         u8 val8;
8221
8222         if (changed & BSS_CHANGED_ASSOC) {
8223                 dev_dbg(dev, "Changed ASSOC: %i!\n", bss_conf->assoc);
8224
8225                 rtl8xxxu_set_linktype(priv, vif->type);
8226
8227                 if (bss_conf->assoc) {
8228                         u32 ramask;
8229                         int sgi = 0;
8230
8231                         rcu_read_lock();
8232                         sta = ieee80211_find_sta(vif, bss_conf->bssid);
8233                         if (!sta) {
8234                                 dev_info(dev, "%s: ASSOC no sta found\n",
8235                                          __func__);
8236                                 rcu_read_unlock();
8237                                 goto error;
8238                         }
8239
8240                         if (sta->ht_cap.ht_supported)
8241                                 dev_info(dev, "%s: HT supported\n", __func__);
8242                         if (sta->vht_cap.vht_supported)
8243                                 dev_info(dev, "%s: VHT supported\n", __func__);
8244
8245                         /* TODO: Set bits 28-31 for rate adaptive id */
8246                         ramask = (sta->supp_rates[0] & 0xfff) |
8247                                 sta->ht_cap.mcs.rx_mask[0] << 12 |
8248                                 sta->ht_cap.mcs.rx_mask[1] << 20;
8249                         if (sta->ht_cap.cap &
8250                             (IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_SGI_20))
8251                                 sgi = 1;
8252                         rcu_read_unlock();
8253
8254                         priv->fops->update_rate_mask(priv, ramask, sgi);
8255
8256                         rtl8xxxu_write8(priv, REG_BCN_MAX_ERR, 0xff);
8257
8258                         rtl8723a_stop_tx_beacon(priv);
8259
8260                         /* joinbss sequence */
8261                         rtl8xxxu_write16(priv, REG_BCN_PSR_RPT,
8262                                          0xc000 | bss_conf->aid);
8263
8264                         priv->fops->report_connect(priv, 0, true);
8265                 } else {
8266                         val8 = rtl8xxxu_read8(priv, REG_BEACON_CTRL);
8267                         val8 |= BEACON_DISABLE_TSF_UPDATE;
8268                         rtl8xxxu_write8(priv, REG_BEACON_CTRL, val8);
8269
8270                         priv->fops->report_connect(priv, 0, false);
8271                 }
8272         }
8273
8274         if (changed & BSS_CHANGED_ERP_PREAMBLE) {
8275                 dev_dbg(dev, "Changed ERP_PREAMBLE: Use short preamble %i\n",
8276                         bss_conf->use_short_preamble);
8277                 val32 = rtl8xxxu_read32(priv, REG_RESPONSE_RATE_SET);
8278                 if (bss_conf->use_short_preamble)
8279                         val32 |= RSR_ACK_SHORT_PREAMBLE;
8280                 else
8281                         val32 &= ~RSR_ACK_SHORT_PREAMBLE;
8282                 rtl8xxxu_write32(priv, REG_RESPONSE_RATE_SET, val32);
8283         }
8284
8285         if (changed & BSS_CHANGED_ERP_SLOT) {
8286                 dev_dbg(dev, "Changed ERP_SLOT: short_slot_time %i\n",
8287                         bss_conf->use_short_slot);
8288
8289                 if (bss_conf->use_short_slot)
8290                         val8 = 9;
8291                 else
8292                         val8 = 20;
8293                 rtl8xxxu_write8(priv, REG_SLOT, val8);
8294         }
8295
8296         if (changed & BSS_CHANGED_BSSID) {
8297                 dev_dbg(dev, "Changed BSSID!\n");
8298                 rtl8xxxu_set_bssid(priv, bss_conf->bssid);
8299         }
8300
8301         if (changed & BSS_CHANGED_BASIC_RATES) {
8302                 dev_dbg(dev, "Changed BASIC_RATES!\n");
8303                 rtl8xxxu_set_basic_rates(priv, bss_conf->basic_rates);
8304         }
8305 error:
8306         return;
8307 }
8308
8309 static u32 rtl8xxxu_80211_to_rtl_queue(u32 queue)
8310 {
8311         u32 rtlqueue;
8312
8313         switch (queue) {
8314         case IEEE80211_AC_VO:
8315                 rtlqueue = TXDESC_QUEUE_VO;
8316                 break;
8317         case IEEE80211_AC_VI:
8318                 rtlqueue = TXDESC_QUEUE_VI;
8319                 break;
8320         case IEEE80211_AC_BE:
8321                 rtlqueue = TXDESC_QUEUE_BE;
8322                 break;
8323         case IEEE80211_AC_BK:
8324                 rtlqueue = TXDESC_QUEUE_BK;
8325                 break;
8326         default:
8327                 rtlqueue = TXDESC_QUEUE_BE;
8328         }
8329
8330         return rtlqueue;
8331 }
8332
8333 static u32 rtl8xxxu_queue_select(struct ieee80211_hw *hw, struct sk_buff *skb)
8334 {
8335         struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
8336         u32 queue;
8337
8338         if (ieee80211_is_mgmt(hdr->frame_control))
8339                 queue = TXDESC_QUEUE_MGNT;
8340         else
8341                 queue = rtl8xxxu_80211_to_rtl_queue(skb_get_queue_mapping(skb));
8342
8343         return queue;
8344 }
8345
8346 /*
8347  * Despite newer chips 8723b/8812/8821 having a larger TX descriptor
8348  * format. The descriptor checksum is still only calculated over the
8349  * initial 32 bytes of the descriptor!
8350  */
8351 static void rtl8xxxu_calc_tx_desc_csum(struct rtl8xxxu_txdesc32 *tx_desc)
8352 {
8353         __le16 *ptr = (__le16 *)tx_desc;
8354         u16 csum = 0;
8355         int i;
8356
8357         /*
8358          * Clear csum field before calculation, as the csum field is
8359          * in the middle of the struct.
8360          */
8361         tx_desc->csum = cpu_to_le16(0);
8362
8363         for (i = 0; i < (sizeof(struct rtl8xxxu_txdesc32) / sizeof(u16)); i++)
8364                 csum = csum ^ le16_to_cpu(ptr[i]);
8365
8366         tx_desc->csum |= cpu_to_le16(csum);
8367 }
8368
8369 static void rtl8xxxu_free_tx_resources(struct rtl8xxxu_priv *priv)
8370 {
8371         struct rtl8xxxu_tx_urb *tx_urb, *tmp;
8372         unsigned long flags;
8373
8374         spin_lock_irqsave(&priv->tx_urb_lock, flags);
8375         list_for_each_entry_safe(tx_urb, tmp, &priv->tx_urb_free_list, list) {
8376                 list_del(&tx_urb->list);
8377                 priv->tx_urb_free_count--;
8378                 usb_free_urb(&tx_urb->urb);
8379         }
8380         spin_unlock_irqrestore(&priv->tx_urb_lock, flags);
8381 }
8382
8383 static struct rtl8xxxu_tx_urb *
8384 rtl8xxxu_alloc_tx_urb(struct rtl8xxxu_priv *priv)
8385 {
8386         struct rtl8xxxu_tx_urb *tx_urb;
8387         unsigned long flags;
8388
8389         spin_lock_irqsave(&priv->tx_urb_lock, flags);
8390         tx_urb = list_first_entry_or_null(&priv->tx_urb_free_list,
8391                                           struct rtl8xxxu_tx_urb, list);
8392         if (tx_urb) {
8393                 list_del(&tx_urb->list);
8394                 priv->tx_urb_free_count--;
8395                 if (priv->tx_urb_free_count < RTL8XXXU_TX_URB_LOW_WATER &&
8396                     !priv->tx_stopped) {
8397                         priv->tx_stopped = true;
8398                         ieee80211_stop_queues(priv->hw);
8399                 }
8400         }
8401
8402         spin_unlock_irqrestore(&priv->tx_urb_lock, flags);
8403
8404         return tx_urb;
8405 }
8406
8407 static void rtl8xxxu_free_tx_urb(struct rtl8xxxu_priv *priv,
8408                                  struct rtl8xxxu_tx_urb *tx_urb)
8409 {
8410         unsigned long flags;
8411
8412         INIT_LIST_HEAD(&tx_urb->list);
8413
8414         spin_lock_irqsave(&priv->tx_urb_lock, flags);
8415
8416         list_add(&tx_urb->list, &priv->tx_urb_free_list);
8417         priv->tx_urb_free_count++;
8418         if (priv->tx_urb_free_count > RTL8XXXU_TX_URB_HIGH_WATER &&
8419             priv->tx_stopped) {
8420                 priv->tx_stopped = false;
8421                 ieee80211_wake_queues(priv->hw);
8422         }
8423
8424         spin_unlock_irqrestore(&priv->tx_urb_lock, flags);
8425 }
8426
8427 static void rtl8xxxu_tx_complete(struct urb *urb)
8428 {
8429         struct sk_buff *skb = (struct sk_buff *)urb->context;
8430         struct ieee80211_tx_info *tx_info;
8431         struct ieee80211_hw *hw;
8432         struct rtl8xxxu_priv *priv;
8433         struct rtl8xxxu_tx_urb *tx_urb =
8434                 container_of(urb, struct rtl8xxxu_tx_urb, urb);
8435
8436         tx_info = IEEE80211_SKB_CB(skb);
8437         hw = tx_info->rate_driver_data[0];
8438         priv = hw->priv;
8439
8440         skb_pull(skb, priv->fops->tx_desc_size);
8441
8442         ieee80211_tx_info_clear_status(tx_info);
8443         tx_info->status.rates[0].idx = -1;
8444         tx_info->status.rates[0].count = 0;
8445
8446         if (!urb->status)
8447                 tx_info->flags |= IEEE80211_TX_STAT_ACK;
8448
8449         ieee80211_tx_status_irqsafe(hw, skb);
8450
8451         rtl8xxxu_free_tx_urb(priv, tx_urb);
8452 }
8453
8454 static void rtl8xxxu_dump_action(struct device *dev,
8455                                  struct ieee80211_hdr *hdr)
8456 {
8457         struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)hdr;
8458         u16 cap, timeout;
8459
8460         if (!(rtl8xxxu_debug & RTL8XXXU_DEBUG_ACTION))
8461                 return;
8462
8463         switch (mgmt->u.action.u.addba_resp.action_code) {
8464         case WLAN_ACTION_ADDBA_RESP:
8465                 cap = le16_to_cpu(mgmt->u.action.u.addba_resp.capab);
8466                 timeout = le16_to_cpu(mgmt->u.action.u.addba_resp.timeout);
8467                 dev_info(dev, "WLAN_ACTION_ADDBA_RESP: "
8468                          "timeout %i, tid %02x, buf_size %02x, policy %02x, "
8469                          "status %02x\n",
8470                          timeout,
8471                          (cap & IEEE80211_ADDBA_PARAM_TID_MASK) >> 2,
8472                          (cap & IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK) >> 6,
8473                          (cap >> 1) & 0x1,
8474                          le16_to_cpu(mgmt->u.action.u.addba_resp.status));
8475                 break;
8476         case WLAN_ACTION_ADDBA_REQ:
8477                 cap = le16_to_cpu(mgmt->u.action.u.addba_req.capab);
8478                 timeout = le16_to_cpu(mgmt->u.action.u.addba_req.timeout);
8479                 dev_info(dev, "WLAN_ACTION_ADDBA_REQ: "
8480                          "timeout %i, tid %02x, buf_size %02x, policy %02x\n",
8481                          timeout,
8482                          (cap & IEEE80211_ADDBA_PARAM_TID_MASK) >> 2,
8483                          (cap & IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK) >> 6,
8484                          (cap >> 1) & 0x1);
8485                 break;
8486         default:
8487                 dev_info(dev, "action frame %02x\n",
8488                          mgmt->u.action.u.addba_resp.action_code);
8489                 break;
8490         }
8491 }
8492
8493 static void rtl8xxxu_tx(struct ieee80211_hw *hw,
8494                         struct ieee80211_tx_control *control,
8495                         struct sk_buff *skb)
8496 {
8497         struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
8498         struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
8499         struct ieee80211_rate *tx_rate = ieee80211_get_tx_rate(hw, tx_info);
8500         struct rtl8xxxu_priv *priv = hw->priv;
8501         struct rtl8xxxu_txdesc32 *tx_desc;
8502         struct rtl8xxxu_txdesc40 *tx_desc40;
8503         struct rtl8xxxu_tx_urb *tx_urb;
8504         struct ieee80211_sta *sta = NULL;
8505         struct ieee80211_vif *vif = tx_info->control.vif;
8506         struct device *dev = &priv->udev->dev;
8507         u32 queue, rate;
8508         u16 pktlen = skb->len;
8509         u16 seq_number;
8510         u16 rate_flag = tx_info->control.rates[0].flags;
8511         int tx_desc_size = priv->fops->tx_desc_size;
8512         int ret;
8513         bool usedesc40, ampdu_enable;
8514
8515         if (skb_headroom(skb) < tx_desc_size) {
8516                 dev_warn(dev,
8517                          "%s: Not enough headroom (%i) for tx descriptor\n",
8518                          __func__, skb_headroom(skb));
8519                 goto error;
8520         }
8521
8522         if (unlikely(skb->len > (65535 - tx_desc_size))) {
8523                 dev_warn(dev, "%s: Trying to send over-sized skb (%i)\n",
8524                          __func__, skb->len);
8525                 goto error;
8526         }
8527
8528         tx_urb = rtl8xxxu_alloc_tx_urb(priv);
8529         if (!tx_urb) {
8530                 dev_warn(dev, "%s: Unable to allocate tx urb\n", __func__);
8531                 goto error;
8532         }
8533
8534         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_TX)
8535                 dev_info(dev, "%s: TX rate: %d (%d), pkt size %d\n",
8536                          __func__, tx_rate->bitrate, tx_rate->hw_value, pktlen);
8537
8538         if (ieee80211_is_action(hdr->frame_control))
8539                 rtl8xxxu_dump_action(dev, hdr);
8540
8541         usedesc40 = (tx_desc_size == 40);
8542         tx_info->rate_driver_data[0] = hw;
8543
8544         if (control && control->sta)
8545                 sta = control->sta;
8546
8547         tx_desc = (struct rtl8xxxu_txdesc32 *)skb_push(skb, tx_desc_size);
8548
8549         memset(tx_desc, 0, tx_desc_size);
8550         tx_desc->pkt_size = cpu_to_le16(pktlen);
8551         tx_desc->pkt_offset = tx_desc_size;
8552
8553         tx_desc->txdw0 =
8554                 TXDESC_OWN | TXDESC_FIRST_SEGMENT | TXDESC_LAST_SEGMENT;
8555         if (is_multicast_ether_addr(ieee80211_get_DA(hdr)) ||
8556             is_broadcast_ether_addr(ieee80211_get_DA(hdr)))
8557                 tx_desc->txdw0 |= TXDESC_BROADMULTICAST;
8558
8559         queue = rtl8xxxu_queue_select(hw, skb);
8560         tx_desc->txdw1 = cpu_to_le32(queue << TXDESC_QUEUE_SHIFT);
8561
8562         if (tx_info->control.hw_key) {
8563                 switch (tx_info->control.hw_key->cipher) {
8564                 case WLAN_CIPHER_SUITE_WEP40:
8565                 case WLAN_CIPHER_SUITE_WEP104:
8566                 case WLAN_CIPHER_SUITE_TKIP:
8567                         tx_desc->txdw1 |= cpu_to_le32(TXDESC_SEC_RC4);
8568                         break;
8569                 case WLAN_CIPHER_SUITE_CCMP:
8570                         tx_desc->txdw1 |= cpu_to_le32(TXDESC_SEC_AES);
8571                         break;
8572                 default:
8573                         break;
8574                 }
8575         }
8576
8577         /* (tx_info->flags & IEEE80211_TX_CTL_AMPDU) && */
8578         ampdu_enable = false;
8579         if (ieee80211_is_data_qos(hdr->frame_control) && sta) {
8580                 if (sta->ht_cap.ht_supported) {
8581                         u32 ampdu, val32;
8582
8583                         ampdu = (u32)sta->ht_cap.ampdu_density;
8584                         val32 = ampdu << TXDESC_AMPDU_DENSITY_SHIFT;
8585                         tx_desc->txdw2 |= cpu_to_le32(val32);
8586
8587                         ampdu_enable = true;
8588                 }
8589         }
8590
8591         if (rate_flag & IEEE80211_TX_RC_MCS)
8592                 rate = tx_info->control.rates[0].idx + DESC_RATE_MCS0;
8593         else
8594                 rate = tx_rate->hw_value;
8595
8596         seq_number = IEEE80211_SEQ_TO_SN(le16_to_cpu(hdr->seq_ctrl));
8597         if (!usedesc40) {
8598                 tx_desc->txdw5 = cpu_to_le32(rate);
8599
8600                 if (ieee80211_is_data(hdr->frame_control))
8601                         tx_desc->txdw5 |= cpu_to_le32(0x0001ff00);
8602
8603                 tx_desc->txdw3 =
8604                         cpu_to_le32((u32)seq_number << TXDESC32_SEQ_SHIFT);
8605
8606                 if (ampdu_enable)
8607                         tx_desc->txdw1 |= cpu_to_le32(TXDESC32_AGG_ENABLE);
8608                 else
8609                         tx_desc->txdw1 |= cpu_to_le32(TXDESC32_AGG_BREAK);
8610
8611                 if (ieee80211_is_mgmt(hdr->frame_control)) {
8612                         tx_desc->txdw5 = cpu_to_le32(tx_rate->hw_value);
8613                         tx_desc->txdw4 |=
8614                                 cpu_to_le32(TXDESC32_USE_DRIVER_RATE);
8615                         tx_desc->txdw5 |=
8616                                 cpu_to_le32(6 << TXDESC32_RETRY_LIMIT_SHIFT);
8617                         tx_desc->txdw5 |=
8618                                 cpu_to_le32(TXDESC32_RETRY_LIMIT_ENABLE);
8619                 }
8620
8621                 if (ieee80211_is_data_qos(hdr->frame_control))
8622                         tx_desc->txdw4 |= cpu_to_le32(TXDESC32_QOS);
8623
8624                 if (rate_flag & IEEE80211_TX_RC_USE_SHORT_PREAMBLE ||
8625                     (sta && vif && vif->bss_conf.use_short_preamble))
8626                         tx_desc->txdw4 |= cpu_to_le32(TXDESC32_SHORT_PREAMBLE);
8627
8628                 if (rate_flag & IEEE80211_TX_RC_SHORT_GI ||
8629                     (ieee80211_is_data_qos(hdr->frame_control) &&
8630                      sta && sta->ht_cap.cap &
8631                      (IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_SGI_20))) {
8632                         tx_desc->txdw5 |= cpu_to_le32(TXDESC32_SHORT_GI);
8633                 }
8634
8635                 if (rate_flag & IEEE80211_TX_RC_USE_RTS_CTS) {
8636                         /*
8637                          * Use RTS rate 24M - does the mac80211 tell
8638                          * us which to use?
8639                          */
8640                         tx_desc->txdw4 |=
8641                                 cpu_to_le32(DESC_RATE_24M <<
8642                                             TXDESC32_RTS_RATE_SHIFT);
8643                         tx_desc->txdw4 |=
8644                                 cpu_to_le32(TXDESC32_RTS_CTS_ENABLE);
8645                         tx_desc->txdw4 |= cpu_to_le32(TXDESC32_HW_RTS_ENABLE);
8646                 }
8647         } else {
8648                 tx_desc40 = (struct rtl8xxxu_txdesc40 *)tx_desc;
8649
8650                 tx_desc40->txdw4 = cpu_to_le32(rate);
8651                 if (ieee80211_is_data(hdr->frame_control)) {
8652                         tx_desc->txdw4 |=
8653                                 cpu_to_le32(0x1f <<
8654                                             TXDESC40_DATA_RATE_FB_SHIFT);
8655                 }
8656
8657                 tx_desc40->txdw9 =
8658                         cpu_to_le32((u32)seq_number << TXDESC40_SEQ_SHIFT);
8659
8660                 if (ampdu_enable)
8661                         tx_desc40->txdw2 |= cpu_to_le32(TXDESC40_AGG_ENABLE);
8662                 else
8663                         tx_desc40->txdw2 |= cpu_to_le32(TXDESC40_AGG_BREAK);
8664
8665                 if (ieee80211_is_mgmt(hdr->frame_control)) {
8666                         tx_desc40->txdw4 = cpu_to_le32(tx_rate->hw_value);
8667                         tx_desc40->txdw3 |=
8668                                 cpu_to_le32(TXDESC40_USE_DRIVER_RATE);
8669                         tx_desc40->txdw4 |=
8670                                 cpu_to_le32(6 << TXDESC40_RETRY_LIMIT_SHIFT);
8671                         tx_desc40->txdw4 |=
8672                                 cpu_to_le32(TXDESC40_RETRY_LIMIT_ENABLE);
8673                 }
8674
8675                 if (rate_flag & IEEE80211_TX_RC_USE_SHORT_PREAMBLE ||
8676                     (sta && vif && vif->bss_conf.use_short_preamble))
8677                         tx_desc40->txdw5 |=
8678                                 cpu_to_le32(TXDESC40_SHORT_PREAMBLE);
8679
8680                 if (rate_flag & IEEE80211_TX_RC_USE_RTS_CTS) {
8681                         /*
8682                          * Use RTS rate 24M - does the mac80211 tell
8683                          * us which to use?
8684                          */
8685                         tx_desc->txdw4 |=
8686                                 cpu_to_le32(DESC_RATE_24M <<
8687                                             TXDESC40_RTS_RATE_SHIFT);
8688                         tx_desc->txdw3 |= cpu_to_le32(TXDESC40_RTS_CTS_ENABLE);
8689                         tx_desc->txdw3 |= cpu_to_le32(TXDESC40_HW_RTS_ENABLE);
8690                 }
8691         }
8692
8693         rtl8xxxu_calc_tx_desc_csum(tx_desc);
8694
8695         usb_fill_bulk_urb(&tx_urb->urb, priv->udev, priv->pipe_out[queue],
8696                           skb->data, skb->len, rtl8xxxu_tx_complete, skb);
8697
8698         usb_anchor_urb(&tx_urb->urb, &priv->tx_anchor);
8699         ret = usb_submit_urb(&tx_urb->urb, GFP_ATOMIC);
8700         if (ret) {
8701                 usb_unanchor_urb(&tx_urb->urb);
8702                 rtl8xxxu_free_tx_urb(priv, tx_urb);
8703                 goto error;
8704         }
8705         return;
8706 error:
8707         dev_kfree_skb(skb);
8708 }
8709
8710 static void rtl8xxxu_rx_parse_phystats(struct rtl8xxxu_priv *priv,
8711                                        struct ieee80211_rx_status *rx_status,
8712                                        struct rtl8723au_phy_stats *phy_stats,
8713                                        u32 rxmcs)
8714 {
8715         if (phy_stats->sgi_en)
8716                 rx_status->flag |= RX_FLAG_SHORT_GI;
8717
8718         if (rxmcs < DESC_RATE_6M) {
8719                 /*
8720                  * Handle PHY stats for CCK rates
8721                  */
8722                 u8 cck_agc_rpt = phy_stats->cck_agc_rpt_ofdm_cfosho_a;
8723
8724                 switch (cck_agc_rpt & 0xc0) {
8725                 case 0xc0:
8726                         rx_status->signal = -46 - (cck_agc_rpt & 0x3e);
8727                         break;
8728                 case 0x80:
8729                         rx_status->signal = -26 - (cck_agc_rpt & 0x3e);
8730                         break;
8731                 case 0x40:
8732                         rx_status->signal = -12 - (cck_agc_rpt & 0x3e);
8733                         break;
8734                 case 0x00:
8735                         rx_status->signal = 16 - (cck_agc_rpt & 0x3e);
8736                         break;
8737                 }
8738         } else {
8739                 rx_status->signal =
8740                         (phy_stats->cck_sig_qual_ofdm_pwdb_all >> 1) - 110;
8741         }
8742 }
8743
8744 static void rtl8xxxu_free_rx_resources(struct rtl8xxxu_priv *priv)
8745 {
8746         struct rtl8xxxu_rx_urb *rx_urb, *tmp;
8747         unsigned long flags;
8748
8749         spin_lock_irqsave(&priv->rx_urb_lock, flags);
8750
8751         list_for_each_entry_safe(rx_urb, tmp,
8752                                  &priv->rx_urb_pending_list, list) {
8753                 list_del(&rx_urb->list);
8754                 priv->rx_urb_pending_count--;
8755                 usb_free_urb(&rx_urb->urb);
8756         }
8757
8758         spin_unlock_irqrestore(&priv->rx_urb_lock, flags);
8759 }
8760
8761 static void rtl8xxxu_queue_rx_urb(struct rtl8xxxu_priv *priv,
8762                                   struct rtl8xxxu_rx_urb *rx_urb)
8763 {
8764         struct sk_buff *skb;
8765         unsigned long flags;
8766         int pending = 0;
8767
8768         spin_lock_irqsave(&priv->rx_urb_lock, flags);
8769
8770         if (!priv->shutdown) {
8771                 list_add_tail(&rx_urb->list, &priv->rx_urb_pending_list);
8772                 priv->rx_urb_pending_count++;
8773                 pending = priv->rx_urb_pending_count;
8774         } else {
8775                 skb = (struct sk_buff *)rx_urb->urb.context;
8776                 dev_kfree_skb(skb);
8777                 usb_free_urb(&rx_urb->urb);
8778         }
8779
8780         spin_unlock_irqrestore(&priv->rx_urb_lock, flags);
8781
8782         if (pending > RTL8XXXU_RX_URB_PENDING_WATER)
8783                 schedule_work(&priv->rx_urb_wq);
8784 }
8785
8786 static void rtl8xxxu_rx_urb_work(struct work_struct *work)
8787 {
8788         struct rtl8xxxu_priv *priv;
8789         struct rtl8xxxu_rx_urb *rx_urb, *tmp;
8790         struct list_head local;
8791         struct sk_buff *skb;
8792         unsigned long flags;
8793         int ret;
8794
8795         priv = container_of(work, struct rtl8xxxu_priv, rx_urb_wq);
8796         INIT_LIST_HEAD(&local);
8797
8798         spin_lock_irqsave(&priv->rx_urb_lock, flags);
8799
8800         list_splice_init(&priv->rx_urb_pending_list, &local);
8801         priv->rx_urb_pending_count = 0;
8802
8803         spin_unlock_irqrestore(&priv->rx_urb_lock, flags);
8804
8805         list_for_each_entry_safe(rx_urb, tmp, &local, list) {
8806                 list_del_init(&rx_urb->list);
8807                 ret = rtl8xxxu_submit_rx_urb(priv, rx_urb);
8808                 /*
8809                  * If out of memory or temporary error, put it back on the
8810                  * queue and try again. Otherwise the device is dead/gone
8811                  * and we should drop it.
8812                  */
8813                 switch (ret) {
8814                 case 0:
8815                         break;
8816                 case -ENOMEM:
8817                 case -EAGAIN:
8818                         rtl8xxxu_queue_rx_urb(priv, rx_urb);
8819                         break;
8820                 default:
8821                         pr_info("failed to requeue urb %i\n", ret);
8822                         skb = (struct sk_buff *)rx_urb->urb.context;
8823                         dev_kfree_skb(skb);
8824                         usb_free_urb(&rx_urb->urb);
8825                 }
8826         }
8827 }
8828
8829 static int rtl8xxxu_parse_rxdesc16(struct rtl8xxxu_priv *priv,
8830                                    struct sk_buff *skb,
8831                                    struct ieee80211_rx_status *rx_status)
8832 {
8833         struct rtl8xxxu_rxdesc16 *rx_desc =
8834                 (struct rtl8xxxu_rxdesc16 *)skb->data;
8835         struct rtl8723au_phy_stats *phy_stats;
8836         __le32 *_rx_desc_le = (__le32 *)skb->data;
8837         u32 *_rx_desc = (u32 *)skb->data;
8838         int drvinfo_sz, desc_shift;
8839         int i;
8840
8841         for (i = 0; i < (sizeof(struct rtl8xxxu_rxdesc16) / sizeof(u32)); i++)
8842                 _rx_desc[i] = le32_to_cpu(_rx_desc_le[i]);
8843
8844         skb_pull(skb, sizeof(struct rtl8xxxu_rxdesc16));
8845
8846         phy_stats = (struct rtl8723au_phy_stats *)skb->data;
8847
8848         drvinfo_sz = rx_desc->drvinfo_sz * 8;
8849         desc_shift = rx_desc->shift;
8850         skb_pull(skb, drvinfo_sz + desc_shift);
8851
8852         if (rx_desc->phy_stats)
8853                 rtl8xxxu_rx_parse_phystats(priv, rx_status, phy_stats,
8854                                            rx_desc->rxmcs);
8855
8856         rx_status->mactime = le32_to_cpu(rx_desc->tsfl);
8857         rx_status->flag |= RX_FLAG_MACTIME_START;
8858
8859         if (!rx_desc->swdec)
8860                 rx_status->flag |= RX_FLAG_DECRYPTED;
8861         if (rx_desc->crc32)
8862                 rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
8863         if (rx_desc->bw)
8864                 rx_status->flag |= RX_FLAG_40MHZ;
8865
8866         if (rx_desc->rxht) {
8867                 rx_status->flag |= RX_FLAG_HT;
8868                 rx_status->rate_idx = rx_desc->rxmcs - DESC_RATE_MCS0;
8869         } else {
8870                 rx_status->rate_idx = rx_desc->rxmcs;
8871         }
8872
8873         return RX_TYPE_DATA_PKT;
8874 }
8875
8876 static int rtl8xxxu_parse_rxdesc24(struct rtl8xxxu_priv *priv,
8877                                    struct sk_buff *skb,
8878                                    struct ieee80211_rx_status *rx_status)
8879 {
8880         struct rtl8xxxu_rxdesc24 *rx_desc =
8881                 (struct rtl8xxxu_rxdesc24 *)skb->data;
8882         struct rtl8723au_phy_stats *phy_stats;
8883         __le32 *_rx_desc_le = (__le32 *)skb->data;
8884         u32 *_rx_desc = (u32 *)skb->data;
8885         int drvinfo_sz, desc_shift;
8886         int i;
8887
8888         for (i = 0; i < (sizeof(struct rtl8xxxu_rxdesc24) / sizeof(u32)); i++)
8889                 _rx_desc[i] = le32_to_cpu(_rx_desc_le[i]);
8890
8891         skb_pull(skb, sizeof(struct rtl8xxxu_rxdesc24));
8892
8893         phy_stats = (struct rtl8723au_phy_stats *)skb->data;
8894
8895         drvinfo_sz = rx_desc->drvinfo_sz * 8;
8896         desc_shift = rx_desc->shift;
8897         skb_pull(skb, drvinfo_sz + desc_shift);
8898
8899         if (rx_desc->rpt_sel) {
8900                 struct device *dev = &priv->udev->dev;
8901                 dev_dbg(dev, "%s: C2H packet\n", __func__);
8902                 return RX_TYPE_C2H;
8903         }
8904
8905         if (rx_desc->phy_stats)
8906                 rtl8xxxu_rx_parse_phystats(priv, rx_status, phy_stats,
8907                                            rx_desc->rxmcs);
8908
8909         rx_status->mactime = le32_to_cpu(rx_desc->tsfl);
8910         rx_status->flag |= RX_FLAG_MACTIME_START;
8911
8912         if (!rx_desc->swdec)
8913                 rx_status->flag |= RX_FLAG_DECRYPTED;
8914         if (rx_desc->crc32)
8915                 rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
8916         if (rx_desc->bw)
8917                 rx_status->flag |= RX_FLAG_40MHZ;
8918
8919         if (rx_desc->rxmcs >= DESC_RATE_MCS0) {
8920                 rx_status->flag |= RX_FLAG_HT;
8921                 rx_status->rate_idx = rx_desc->rxmcs - DESC_RATE_MCS0;
8922         } else {
8923                 rx_status->rate_idx = rx_desc->rxmcs;
8924         }
8925
8926         return RX_TYPE_DATA_PKT;
8927 }
8928
8929 static void rtl8723bu_handle_c2h(struct rtl8xxxu_priv *priv,
8930                                  struct sk_buff *skb)
8931 {
8932         struct rtl8723bu_c2h *c2h = (struct rtl8723bu_c2h *)skb->data;
8933         struct device *dev = &priv->udev->dev;
8934         int len;
8935
8936         len = skb->len - 2;
8937
8938         dev_dbg(dev, "C2H ID %02x seq %02x, len %02x source %02x\n",
8939                 c2h->id, c2h->seq, len, c2h->bt_info.response_source);
8940
8941         switch(c2h->id) {
8942         case C2H_8723B_BT_INFO:
8943                 if (c2h->bt_info.response_source >
8944                     BT_INFO_SRC_8723B_BT_ACTIVE_SEND)
8945                         dev_dbg(dev, "C2H_BT_INFO WiFi only firmware\n");
8946                 else
8947                         dev_dbg(dev, "C2H_BT_INFO BT/WiFi coexist firmware\n");
8948
8949                 if (c2h->bt_info.bt_has_reset)
8950                         dev_dbg(dev, "BT has been reset\n");
8951                 if (c2h->bt_info.tx_rx_mask)
8952                         dev_dbg(dev, "BT TRx mask\n");
8953
8954                 break;
8955         case C2H_8723B_BT_MP_INFO:
8956                 dev_dbg(dev, "C2H_MP_INFO ext ID %02x, status %02x\n",
8957                         c2h->bt_mp_info.ext_id, c2h->bt_mp_info.status);
8958                 break;
8959         case C2H_8723B_RA_REPORT:
8960                 dev_dbg(dev,
8961                         "C2H RA RPT: rate %02x, unk %i, macid %02x, noise %i\n",
8962                         c2h->ra_report.rate, c2h->ra_report.dummy0_0,
8963                         c2h->ra_report.macid, c2h->ra_report.noisy_state);
8964                 break;
8965         default:
8966                 dev_info(dev, "Unhandled C2H event %02x seq %02x\n",
8967                          c2h->id, c2h->seq);
8968                 print_hex_dump(KERN_INFO, "C2H content: ", DUMP_PREFIX_NONE,
8969                                16, 1, c2h->raw.payload, len, false);
8970                 break;
8971         }
8972 }
8973
8974 static void rtl8xxxu_rx_complete(struct urb *urb)
8975 {
8976         struct rtl8xxxu_rx_urb *rx_urb =
8977                 container_of(urb, struct rtl8xxxu_rx_urb, urb);
8978         struct ieee80211_hw *hw = rx_urb->hw;
8979         struct rtl8xxxu_priv *priv = hw->priv;
8980         struct sk_buff *skb = (struct sk_buff *)urb->context;
8981         struct ieee80211_rx_status *rx_status = IEEE80211_SKB_RXCB(skb);
8982         struct device *dev = &priv->udev->dev;
8983         int rx_type;
8984
8985         skb_put(skb, urb->actual_length);
8986
8987         if (urb->status == 0) {
8988                 memset(rx_status, 0, sizeof(struct ieee80211_rx_status));
8989
8990                 rx_type = priv->fops->parse_rx_desc(priv, skb, rx_status);
8991
8992                 rx_status->freq = hw->conf.chandef.chan->center_freq;
8993                 rx_status->band = hw->conf.chandef.chan->band;
8994
8995                 if (rx_type == RX_TYPE_DATA_PKT)
8996                         ieee80211_rx_irqsafe(hw, skb);
8997                 else {
8998                         rtl8723bu_handle_c2h(priv, skb);
8999                         dev_kfree_skb(skb);
9000                 }
9001
9002                 skb = NULL;
9003                 rx_urb->urb.context = NULL;
9004                 rtl8xxxu_queue_rx_urb(priv, rx_urb);
9005         } else {
9006                 dev_dbg(dev, "%s: status %i\n", __func__, urb->status);
9007                 goto cleanup;
9008         }
9009         return;
9010
9011 cleanup:
9012         usb_free_urb(urb);
9013         dev_kfree_skb(skb);
9014         return;
9015 }
9016
9017 static int rtl8xxxu_submit_rx_urb(struct rtl8xxxu_priv *priv,
9018                                   struct rtl8xxxu_rx_urb *rx_urb)
9019 {
9020         struct sk_buff *skb;
9021         int skb_size;
9022         int ret, rx_desc_sz;
9023
9024         rx_desc_sz = priv->fops->rx_desc_size;
9025         skb_size = rx_desc_sz + RTL_RX_BUFFER_SIZE;
9026         skb = __netdev_alloc_skb(NULL, skb_size, GFP_KERNEL);
9027         if (!skb)
9028                 return -ENOMEM;
9029
9030         memset(skb->data, 0, rx_desc_sz);
9031         usb_fill_bulk_urb(&rx_urb->urb, priv->udev, priv->pipe_in, skb->data,
9032                           skb_size, rtl8xxxu_rx_complete, skb);
9033         usb_anchor_urb(&rx_urb->urb, &priv->rx_anchor);
9034         ret = usb_submit_urb(&rx_urb->urb, GFP_ATOMIC);
9035         if (ret)
9036                 usb_unanchor_urb(&rx_urb->urb);
9037         return ret;
9038 }
9039
9040 static void rtl8xxxu_int_complete(struct urb *urb)
9041 {
9042         struct rtl8xxxu_priv *priv = (struct rtl8xxxu_priv *)urb->context;
9043         struct device *dev = &priv->udev->dev;
9044         int ret;
9045
9046         dev_dbg(dev, "%s: status %i\n", __func__, urb->status);
9047         if (urb->status == 0) {
9048                 usb_anchor_urb(urb, &priv->int_anchor);
9049                 ret = usb_submit_urb(urb, GFP_ATOMIC);
9050                 if (ret)
9051                         usb_unanchor_urb(urb);
9052         } else {
9053                 dev_info(dev, "%s: Error %i\n", __func__, urb->status);
9054         }
9055 }
9056
9057
9058 static int rtl8xxxu_submit_int_urb(struct ieee80211_hw *hw)
9059 {
9060         struct rtl8xxxu_priv *priv = hw->priv;
9061         struct urb *urb;
9062         u32 val32;
9063         int ret;
9064
9065         urb = usb_alloc_urb(0, GFP_KERNEL);
9066         if (!urb)
9067                 return -ENOMEM;
9068
9069         usb_fill_int_urb(urb, priv->udev, priv->pipe_interrupt,
9070                          priv->int_buf, USB_INTR_CONTENT_LENGTH,
9071                          rtl8xxxu_int_complete, priv, 1);
9072         usb_anchor_urb(urb, &priv->int_anchor);
9073         ret = usb_submit_urb(urb, GFP_KERNEL);
9074         if (ret) {
9075                 usb_unanchor_urb(urb);
9076                 goto error;
9077         }
9078
9079         val32 = rtl8xxxu_read32(priv, REG_USB_HIMR);
9080         val32 |= USB_HIMR_CPWM;
9081         rtl8xxxu_write32(priv, REG_USB_HIMR, val32);
9082
9083 error:
9084         return ret;
9085 }
9086
9087 static int rtl8xxxu_add_interface(struct ieee80211_hw *hw,
9088                                   struct ieee80211_vif *vif)
9089 {
9090         struct rtl8xxxu_priv *priv = hw->priv;
9091         int ret;
9092         u8 val8;
9093
9094         switch (vif->type) {
9095         case NL80211_IFTYPE_STATION:
9096                 rtl8723a_stop_tx_beacon(priv);
9097
9098                 val8 = rtl8xxxu_read8(priv, REG_BEACON_CTRL);
9099                 val8 |= BEACON_ATIM | BEACON_FUNCTION_ENABLE |
9100                         BEACON_DISABLE_TSF_UPDATE;
9101                 rtl8xxxu_write8(priv, REG_BEACON_CTRL, val8);
9102                 ret = 0;
9103                 break;
9104         default:
9105                 ret = -EOPNOTSUPP;
9106         }
9107
9108         rtl8xxxu_set_linktype(priv, vif->type);
9109
9110         return ret;
9111 }
9112
9113 static void rtl8xxxu_remove_interface(struct ieee80211_hw *hw,
9114                                       struct ieee80211_vif *vif)
9115 {
9116         struct rtl8xxxu_priv *priv = hw->priv;
9117
9118         dev_dbg(&priv->udev->dev, "%s\n", __func__);
9119 }
9120
9121 static int rtl8xxxu_config(struct ieee80211_hw *hw, u32 changed)
9122 {
9123         struct rtl8xxxu_priv *priv = hw->priv;
9124         struct device *dev = &priv->udev->dev;
9125         u16 val16;
9126         int ret = 0, channel;
9127         bool ht40;
9128
9129         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_CHANNEL)
9130                 dev_info(dev,
9131                          "%s: channel: %i (changed %08x chandef.width %02x)\n",
9132                          __func__, hw->conf.chandef.chan->hw_value,
9133                          changed, hw->conf.chandef.width);
9134
9135         if (changed & IEEE80211_CONF_CHANGE_RETRY_LIMITS) {
9136                 val16 = ((hw->conf.long_frame_max_tx_count <<
9137                           RETRY_LIMIT_LONG_SHIFT) & RETRY_LIMIT_LONG_MASK) |
9138                         ((hw->conf.short_frame_max_tx_count <<
9139                           RETRY_LIMIT_SHORT_SHIFT) & RETRY_LIMIT_SHORT_MASK);
9140                 rtl8xxxu_write16(priv, REG_RETRY_LIMIT, val16);
9141         }
9142
9143         if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
9144                 switch (hw->conf.chandef.width) {
9145                 case NL80211_CHAN_WIDTH_20_NOHT:
9146                 case NL80211_CHAN_WIDTH_20:
9147                         ht40 = false;
9148                         break;
9149                 case NL80211_CHAN_WIDTH_40:
9150                         ht40 = true;
9151                         break;
9152                 default:
9153                         ret = -ENOTSUPP;
9154                         goto exit;
9155                 }
9156
9157                 channel = hw->conf.chandef.chan->hw_value;
9158
9159                 priv->fops->set_tx_power(priv, channel, ht40);
9160
9161                 priv->fops->config_channel(hw);
9162         }
9163
9164 exit:
9165         return ret;
9166 }
9167
9168 static int rtl8xxxu_conf_tx(struct ieee80211_hw *hw,
9169                             struct ieee80211_vif *vif, u16 queue,
9170                             const struct ieee80211_tx_queue_params *param)
9171 {
9172         struct rtl8xxxu_priv *priv = hw->priv;
9173         struct device *dev = &priv->udev->dev;
9174         u32 val32;
9175         u8 aifs, acm_ctrl, acm_bit;
9176
9177         aifs = param->aifs;
9178
9179         val32 = aifs |
9180                 fls(param->cw_min) << EDCA_PARAM_ECW_MIN_SHIFT |
9181                 fls(param->cw_max) << EDCA_PARAM_ECW_MAX_SHIFT |
9182                 (u32)param->txop << EDCA_PARAM_TXOP_SHIFT;
9183
9184         acm_ctrl = rtl8xxxu_read8(priv, REG_ACM_HW_CTRL);
9185         dev_dbg(dev,
9186                 "%s: IEEE80211 queue %02x val %08x, acm %i, acm_ctrl %02x\n",
9187                 __func__, queue, val32, param->acm, acm_ctrl);
9188
9189         switch (queue) {
9190         case IEEE80211_AC_VO:
9191                 acm_bit = ACM_HW_CTRL_VO;
9192                 rtl8xxxu_write32(priv, REG_EDCA_VO_PARAM, val32);
9193                 break;
9194         case IEEE80211_AC_VI:
9195                 acm_bit = ACM_HW_CTRL_VI;
9196                 rtl8xxxu_write32(priv, REG_EDCA_VI_PARAM, val32);
9197                 break;
9198         case IEEE80211_AC_BE:
9199                 acm_bit = ACM_HW_CTRL_BE;
9200                 rtl8xxxu_write32(priv, REG_EDCA_BE_PARAM, val32);
9201                 break;
9202         case IEEE80211_AC_BK:
9203                 acm_bit = ACM_HW_CTRL_BK;
9204                 rtl8xxxu_write32(priv, REG_EDCA_BK_PARAM, val32);
9205                 break;
9206         default:
9207                 acm_bit = 0;
9208                 break;
9209         }
9210
9211         if (param->acm)
9212                 acm_ctrl |= acm_bit;
9213         else
9214                 acm_ctrl &= ~acm_bit;
9215         rtl8xxxu_write8(priv, REG_ACM_HW_CTRL, acm_ctrl);
9216
9217         return 0;
9218 }
9219
9220 static void rtl8xxxu_configure_filter(struct ieee80211_hw *hw,
9221                                       unsigned int changed_flags,
9222                                       unsigned int *total_flags, u64 multicast)
9223 {
9224         struct rtl8xxxu_priv *priv = hw->priv;
9225         u32 rcr = rtl8xxxu_read32(priv, REG_RCR);
9226
9227         dev_dbg(&priv->udev->dev, "%s: changed_flags %08x, total_flags %08x\n",
9228                 __func__, changed_flags, *total_flags);
9229
9230         /*
9231          * FIF_ALLMULTI ignored as all multicast frames are accepted (REG_MAR)
9232          */
9233
9234         if (*total_flags & FIF_FCSFAIL)
9235                 rcr |= RCR_ACCEPT_CRC32;
9236         else
9237                 rcr &= ~RCR_ACCEPT_CRC32;
9238
9239         /*
9240          * FIF_PLCPFAIL not supported?
9241          */
9242
9243         if (*total_flags & FIF_BCN_PRBRESP_PROMISC)
9244                 rcr &= ~RCR_CHECK_BSSID_BEACON;
9245         else
9246                 rcr |= RCR_CHECK_BSSID_BEACON;
9247
9248         if (*total_flags & FIF_CONTROL)
9249                 rcr |= RCR_ACCEPT_CTRL_FRAME;
9250         else
9251                 rcr &= ~RCR_ACCEPT_CTRL_FRAME;
9252
9253         if (*total_flags & FIF_OTHER_BSS) {
9254                 rcr |= RCR_ACCEPT_AP;
9255                 rcr &= ~RCR_CHECK_BSSID_MATCH;
9256         } else {
9257                 rcr &= ~RCR_ACCEPT_AP;
9258                 rcr |= RCR_CHECK_BSSID_MATCH;
9259         }
9260
9261         if (*total_flags & FIF_PSPOLL)
9262                 rcr |= RCR_ACCEPT_PM;
9263         else
9264                 rcr &= ~RCR_ACCEPT_PM;
9265
9266         /*
9267          * FIF_PROBE_REQ ignored as probe requests always seem to be accepted
9268          */
9269
9270         rtl8xxxu_write32(priv, REG_RCR, rcr);
9271
9272         *total_flags &= (FIF_ALLMULTI | FIF_FCSFAIL | FIF_BCN_PRBRESP_PROMISC |
9273                          FIF_CONTROL | FIF_OTHER_BSS | FIF_PSPOLL |
9274                          FIF_PROBE_REQ);
9275 }
9276
9277 static int rtl8xxxu_set_rts_threshold(struct ieee80211_hw *hw, u32 rts)
9278 {
9279         if (rts > 2347)
9280                 return -EINVAL;
9281
9282         return 0;
9283 }
9284
9285 static int rtl8xxxu_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
9286                             struct ieee80211_vif *vif,
9287                             struct ieee80211_sta *sta,
9288                             struct ieee80211_key_conf *key)
9289 {
9290         struct rtl8xxxu_priv *priv = hw->priv;
9291         struct device *dev = &priv->udev->dev;
9292         u8 mac_addr[ETH_ALEN];
9293         u8 val8;
9294         u16 val16;
9295         u32 val32;
9296         int retval = -EOPNOTSUPP;
9297
9298         dev_dbg(dev, "%s: cmd %02x, cipher %08x, index %i\n",
9299                 __func__, cmd, key->cipher, key->keyidx);
9300
9301         if (vif->type != NL80211_IFTYPE_STATION)
9302                 return -EOPNOTSUPP;
9303
9304         if (key->keyidx > 3)
9305                 return -EOPNOTSUPP;
9306
9307         switch (key->cipher) {
9308         case WLAN_CIPHER_SUITE_WEP40:
9309         case WLAN_CIPHER_SUITE_WEP104:
9310
9311                 break;
9312         case WLAN_CIPHER_SUITE_CCMP:
9313                 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX;
9314                 break;
9315         case WLAN_CIPHER_SUITE_TKIP:
9316                 key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
9317         default:
9318                 return -EOPNOTSUPP;
9319         }
9320
9321         if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE) {
9322                 dev_dbg(dev, "%s: pairwise key\n", __func__);
9323                 ether_addr_copy(mac_addr, sta->addr);
9324         } else {
9325                 dev_dbg(dev, "%s: group key\n", __func__);
9326                 eth_broadcast_addr(mac_addr);
9327         }
9328
9329         val16 = rtl8xxxu_read16(priv, REG_CR);
9330         val16 |= CR_SECURITY_ENABLE;
9331         rtl8xxxu_write16(priv, REG_CR, val16);
9332
9333         val8 = SEC_CFG_TX_SEC_ENABLE | SEC_CFG_TXBC_USE_DEFKEY |
9334                 SEC_CFG_RX_SEC_ENABLE | SEC_CFG_RXBC_USE_DEFKEY;
9335         val8 |= SEC_CFG_TX_USE_DEFKEY | SEC_CFG_RX_USE_DEFKEY;
9336         rtl8xxxu_write8(priv, REG_SECURITY_CFG, val8);
9337
9338         switch (cmd) {
9339         case SET_KEY:
9340                 key->hw_key_idx = key->keyidx;
9341                 key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
9342                 rtl8xxxu_cam_write(priv, key, mac_addr);
9343                 retval = 0;
9344                 break;
9345         case DISABLE_KEY:
9346                 rtl8xxxu_write32(priv, REG_CAM_WRITE, 0x00000000);
9347                 val32 = CAM_CMD_POLLING | CAM_CMD_WRITE |
9348                         key->keyidx << CAM_CMD_KEY_SHIFT;
9349                 rtl8xxxu_write32(priv, REG_CAM_CMD, val32);
9350                 retval = 0;
9351                 break;
9352         default:
9353                 dev_warn(dev, "%s: Unsupported command %02x\n", __func__, cmd);
9354         }
9355
9356         return retval;
9357 }
9358
9359 static int
9360 rtl8xxxu_ampdu_action(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
9361                       struct ieee80211_ampdu_params *params)
9362 {
9363         struct rtl8xxxu_priv *priv = hw->priv;
9364         struct device *dev = &priv->udev->dev;
9365         u8 ampdu_factor, ampdu_density;
9366         struct ieee80211_sta *sta = params->sta;
9367         enum ieee80211_ampdu_mlme_action action = params->action;
9368
9369         switch (action) {
9370         case IEEE80211_AMPDU_TX_START:
9371                 dev_info(dev, "%s: IEEE80211_AMPDU_TX_START\n", __func__);
9372                 ampdu_factor = sta->ht_cap.ampdu_factor;
9373                 ampdu_density = sta->ht_cap.ampdu_density;
9374                 rtl8xxxu_set_ampdu_factor(priv, ampdu_factor);
9375                 rtl8xxxu_set_ampdu_min_space(priv, ampdu_density);
9376                 dev_dbg(dev,
9377                         "Changed HT: ampdu_factor %02x, ampdu_density %02x\n",
9378                         ampdu_factor, ampdu_density);
9379                 break;
9380         case IEEE80211_AMPDU_TX_STOP_FLUSH:
9381                 dev_info(dev, "%s: IEEE80211_AMPDU_TX_STOP_FLUSH\n", __func__);
9382                 rtl8xxxu_set_ampdu_factor(priv, 0);
9383                 rtl8xxxu_set_ampdu_min_space(priv, 0);
9384                 break;
9385         case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT:
9386                 dev_info(dev, "%s: IEEE80211_AMPDU_TX_STOP_FLUSH_CONT\n",
9387                          __func__);
9388                 rtl8xxxu_set_ampdu_factor(priv, 0);
9389                 rtl8xxxu_set_ampdu_min_space(priv, 0);
9390                 break;
9391         case IEEE80211_AMPDU_RX_START:
9392                 dev_info(dev, "%s: IEEE80211_AMPDU_RX_START\n", __func__);
9393                 break;
9394         case IEEE80211_AMPDU_RX_STOP:
9395                 dev_info(dev, "%s: IEEE80211_AMPDU_RX_STOP\n", __func__);
9396                 break;
9397         default:
9398                 break;
9399         }
9400         return 0;
9401 }
9402
9403 static int rtl8xxxu_start(struct ieee80211_hw *hw)
9404 {
9405         struct rtl8xxxu_priv *priv = hw->priv;
9406         struct rtl8xxxu_rx_urb *rx_urb;
9407         struct rtl8xxxu_tx_urb *tx_urb;
9408         unsigned long flags;
9409         int ret, i;
9410
9411         ret = 0;
9412
9413         init_usb_anchor(&priv->rx_anchor);
9414         init_usb_anchor(&priv->tx_anchor);
9415         init_usb_anchor(&priv->int_anchor);
9416
9417         priv->fops->enable_rf(priv);
9418         if (priv->usb_interrupts) {
9419                 ret = rtl8xxxu_submit_int_urb(hw);
9420                 if (ret)
9421                         goto exit;
9422         }
9423
9424         for (i = 0; i < RTL8XXXU_TX_URBS; i++) {
9425                 tx_urb = kmalloc(sizeof(struct rtl8xxxu_tx_urb), GFP_KERNEL);
9426                 if (!tx_urb) {
9427                         if (!i)
9428                                 ret = -ENOMEM;
9429
9430                         goto error_out;
9431                 }
9432                 usb_init_urb(&tx_urb->urb);
9433                 INIT_LIST_HEAD(&tx_urb->list);
9434                 tx_urb->hw = hw;
9435                 list_add(&tx_urb->list, &priv->tx_urb_free_list);
9436                 priv->tx_urb_free_count++;
9437         }
9438
9439         priv->tx_stopped = false;
9440
9441         spin_lock_irqsave(&priv->rx_urb_lock, flags);
9442         priv->shutdown = false;
9443         spin_unlock_irqrestore(&priv->rx_urb_lock, flags);
9444
9445         for (i = 0; i < RTL8XXXU_RX_URBS; i++) {
9446                 rx_urb = kmalloc(sizeof(struct rtl8xxxu_rx_urb), GFP_KERNEL);
9447                 if (!rx_urb) {
9448                         if (!i)
9449                                 ret = -ENOMEM;
9450
9451                         goto error_out;
9452                 }
9453                 usb_init_urb(&rx_urb->urb);
9454                 INIT_LIST_HEAD(&rx_urb->list);
9455                 rx_urb->hw = hw;
9456
9457                 ret = rtl8xxxu_submit_rx_urb(priv, rx_urb);
9458         }
9459 exit:
9460         /*
9461          * Accept all data and mgmt frames
9462          */
9463         rtl8xxxu_write16(priv, REG_RXFLTMAP2, 0xffff);
9464         rtl8xxxu_write16(priv, REG_RXFLTMAP0, 0xffff);
9465
9466         rtl8xxxu_write32(priv, REG_OFDM0_XA_AGC_CORE1, 0x6954341e);
9467
9468         return ret;
9469
9470 error_out:
9471         rtl8xxxu_free_tx_resources(priv);
9472         /*
9473          * Disable all data and mgmt frames
9474          */
9475         rtl8xxxu_write16(priv, REG_RXFLTMAP2, 0x0000);
9476         rtl8xxxu_write16(priv, REG_RXFLTMAP0, 0x0000);
9477
9478         return ret;
9479 }
9480
9481 static void rtl8xxxu_stop(struct ieee80211_hw *hw)
9482 {
9483         struct rtl8xxxu_priv *priv = hw->priv;
9484         unsigned long flags;
9485
9486         rtl8xxxu_write8(priv, REG_TXPAUSE, 0xff);
9487
9488         rtl8xxxu_write16(priv, REG_RXFLTMAP0, 0x0000);
9489         rtl8xxxu_write16(priv, REG_RXFLTMAP2, 0x0000);
9490
9491         spin_lock_irqsave(&priv->rx_urb_lock, flags);
9492         priv->shutdown = true;
9493         spin_unlock_irqrestore(&priv->rx_urb_lock, flags);
9494
9495         usb_kill_anchored_urbs(&priv->rx_anchor);
9496         usb_kill_anchored_urbs(&priv->tx_anchor);
9497         if (priv->usb_interrupts)
9498                 usb_kill_anchored_urbs(&priv->int_anchor);
9499
9500         priv->fops->disable_rf(priv);
9501
9502         /*
9503          * Disable interrupts
9504          */
9505         if (priv->usb_interrupts)
9506                 rtl8xxxu_write32(priv, REG_USB_HIMR, 0);
9507
9508         rtl8xxxu_free_rx_resources(priv);
9509         rtl8xxxu_free_tx_resources(priv);
9510 }
9511
9512 static const struct ieee80211_ops rtl8xxxu_ops = {
9513         .tx = rtl8xxxu_tx,
9514         .add_interface = rtl8xxxu_add_interface,
9515         .remove_interface = rtl8xxxu_remove_interface,
9516         .config = rtl8xxxu_config,
9517         .conf_tx = rtl8xxxu_conf_tx,
9518         .bss_info_changed = rtl8xxxu_bss_info_changed,
9519         .configure_filter = rtl8xxxu_configure_filter,
9520         .set_rts_threshold = rtl8xxxu_set_rts_threshold,
9521         .start = rtl8xxxu_start,
9522         .stop = rtl8xxxu_stop,
9523         .sw_scan_start = rtl8xxxu_sw_scan_start,
9524         .sw_scan_complete = rtl8xxxu_sw_scan_complete,
9525         .set_key = rtl8xxxu_set_key,
9526         .ampdu_action = rtl8xxxu_ampdu_action,
9527 };
9528
9529 static int rtl8xxxu_parse_usb(struct rtl8xxxu_priv *priv,
9530                               struct usb_interface *interface)
9531 {
9532         struct usb_interface_descriptor *interface_desc;
9533         struct usb_host_interface *host_interface;
9534         struct usb_endpoint_descriptor *endpoint;
9535         struct device *dev = &priv->udev->dev;
9536         int i, j = 0, endpoints;
9537         u8 dir, xtype, num;
9538         int ret = 0;
9539
9540         host_interface = &interface->altsetting[0];
9541         interface_desc = &host_interface->desc;
9542         endpoints = interface_desc->bNumEndpoints;
9543
9544         for (i = 0; i < endpoints; i++) {
9545                 endpoint = &host_interface->endpoint[i].desc;
9546
9547                 dir = endpoint->bEndpointAddress & USB_ENDPOINT_DIR_MASK;
9548                 num = usb_endpoint_num(endpoint);
9549                 xtype = usb_endpoint_type(endpoint);
9550                 if (rtl8xxxu_debug & RTL8XXXU_DEBUG_USB)
9551                         dev_dbg(dev,
9552                                 "%s: endpoint: dir %02x, # %02x, type %02x\n",
9553                                 __func__, dir, num, xtype);
9554                 if (usb_endpoint_dir_in(endpoint) &&
9555                     usb_endpoint_xfer_bulk(endpoint)) {
9556                         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_USB)
9557                                 dev_dbg(dev, "%s: in endpoint num %i\n",
9558                                         __func__, num);
9559
9560                         if (priv->pipe_in) {
9561                                 dev_warn(dev,
9562                                          "%s: Too many IN pipes\n", __func__);
9563                                 ret = -EINVAL;
9564                                 goto exit;
9565                         }
9566
9567                         priv->pipe_in = usb_rcvbulkpipe(priv->udev, num);
9568                 }
9569
9570                 if (usb_endpoint_dir_in(endpoint) &&
9571                     usb_endpoint_xfer_int(endpoint)) {
9572                         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_USB)
9573                                 dev_dbg(dev, "%s: interrupt endpoint num %i\n",
9574                                         __func__, num);
9575
9576                         if (priv->pipe_interrupt) {
9577                                 dev_warn(dev, "%s: Too many INTERRUPT pipes\n",
9578                                          __func__);
9579                                 ret = -EINVAL;
9580                                 goto exit;
9581                         }
9582
9583                         priv->pipe_interrupt = usb_rcvintpipe(priv->udev, num);
9584                 }
9585
9586                 if (usb_endpoint_dir_out(endpoint) &&
9587                     usb_endpoint_xfer_bulk(endpoint)) {
9588                         if (rtl8xxxu_debug & RTL8XXXU_DEBUG_USB)
9589                                 dev_dbg(dev, "%s: out endpoint num %i\n",
9590                                         __func__, num);
9591                         if (j >= RTL8XXXU_OUT_ENDPOINTS) {
9592                                 dev_warn(dev,
9593                                          "%s: Too many OUT pipes\n", __func__);
9594                                 ret = -EINVAL;
9595                                 goto exit;
9596                         }
9597                         priv->out_ep[j++] = num;
9598                 }
9599         }
9600 exit:
9601         priv->nr_out_eps = j;
9602         return ret;
9603 }
9604
9605 static int rtl8xxxu_probe(struct usb_interface *interface,
9606                           const struct usb_device_id *id)
9607 {
9608         struct rtl8xxxu_priv *priv;
9609         struct ieee80211_hw *hw;
9610         struct usb_device *udev;
9611         struct ieee80211_supported_band *sband;
9612         int ret = 0;
9613         int untested = 1;
9614
9615         udev = usb_get_dev(interface_to_usbdev(interface));
9616
9617         switch (id->idVendor) {
9618         case USB_VENDOR_ID_REALTEK:
9619                 switch(id->idProduct) {
9620                 case 0x1724:
9621                 case 0x8176:
9622                 case 0x8178:
9623                 case 0x817f:
9624                         untested = 0;
9625                         break;
9626                 }
9627                 break;
9628         case 0x7392:
9629                 if (id->idProduct == 0x7811)
9630                         untested = 0;
9631                 break;
9632         default:
9633                 break;
9634         }
9635
9636         if (untested) {
9637                 rtl8xxxu_debug |= RTL8XXXU_DEBUG_EFUSE;
9638                 dev_info(&udev->dev,
9639                          "This Realtek USB WiFi dongle (0x%04x:0x%04x) is untested!\n",
9640                          id->idVendor, id->idProduct);
9641                 dev_info(&udev->dev,
9642                          "Please report results to Jes.Sorensen@gmail.com\n");
9643         }
9644
9645         hw = ieee80211_alloc_hw(sizeof(struct rtl8xxxu_priv), &rtl8xxxu_ops);
9646         if (!hw) {
9647                 ret = -ENOMEM;
9648                 goto exit;
9649         }
9650
9651         priv = hw->priv;
9652         priv->hw = hw;
9653         priv->udev = udev;
9654         priv->fops = (struct rtl8xxxu_fileops *)id->driver_info;
9655         mutex_init(&priv->usb_buf_mutex);
9656         mutex_init(&priv->h2c_mutex);
9657         INIT_LIST_HEAD(&priv->tx_urb_free_list);
9658         spin_lock_init(&priv->tx_urb_lock);
9659         INIT_LIST_HEAD(&priv->rx_urb_pending_list);
9660         spin_lock_init(&priv->rx_urb_lock);
9661         INIT_WORK(&priv->rx_urb_wq, rtl8xxxu_rx_urb_work);
9662
9663         usb_set_intfdata(interface, hw);
9664
9665         ret = rtl8xxxu_parse_usb(priv, interface);
9666         if (ret)
9667                 goto exit;
9668
9669         ret = rtl8xxxu_identify_chip(priv);
9670         if (ret) {
9671                 dev_err(&udev->dev, "Fatal - failed to identify chip\n");
9672                 goto exit;
9673         }
9674
9675         ret = rtl8xxxu_read_efuse(priv);
9676         if (ret) {
9677                 dev_err(&udev->dev, "Fatal - failed to read EFuse\n");
9678                 goto exit;
9679         }
9680
9681         ret = priv->fops->parse_efuse(priv);
9682         if (ret) {
9683                 dev_err(&udev->dev, "Fatal - failed to parse EFuse\n");
9684                 goto exit;
9685         }
9686
9687         rtl8xxxu_print_chipinfo(priv);
9688
9689         ret = priv->fops->load_firmware(priv);
9690         if (ret) {
9691                 dev_err(&udev->dev, "Fatal - failed to load firmware\n");
9692                 goto exit;
9693         }
9694
9695         ret = rtl8xxxu_init_device(hw);
9696
9697         hw->wiphy->max_scan_ssids = 1;
9698         hw->wiphy->max_scan_ie_len = IEEE80211_MAX_DATA_LEN;
9699         hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION);
9700         hw->queues = 4;
9701
9702         sband = &rtl8xxxu_supported_band;
9703         sband->ht_cap.ht_supported = true;
9704         sband->ht_cap.ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K;
9705         sband->ht_cap.ampdu_density = IEEE80211_HT_MPDU_DENSITY_16;
9706         sband->ht_cap.cap = IEEE80211_HT_CAP_SGI_20 | IEEE80211_HT_CAP_SGI_40;
9707         memset(&sband->ht_cap.mcs, 0, sizeof(sband->ht_cap.mcs));
9708         sband->ht_cap.mcs.rx_mask[0] = 0xff;
9709         sband->ht_cap.mcs.rx_mask[4] = 0x01;
9710         if (priv->rf_paths > 1) {
9711                 sband->ht_cap.mcs.rx_mask[1] = 0xff;
9712                 sband->ht_cap.cap |= IEEE80211_HT_CAP_SGI_40;
9713         }
9714         sband->ht_cap.mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED;
9715         /*
9716          * Some APs will negotiate HT20_40 in a noisy environment leading
9717          * to miserable performance. Rather than defaulting to this, only
9718          * enable it if explicitly requested at module load time.
9719          */
9720         if (rtl8xxxu_ht40_2g) {
9721                 dev_info(&udev->dev, "Enabling HT_20_40 on the 2.4GHz band\n");
9722                 sband->ht_cap.cap |= IEEE80211_HT_CAP_SUP_WIDTH_20_40;
9723         }
9724         hw->wiphy->bands[NL80211_BAND_2GHZ] = sband;
9725
9726         hw->wiphy->rts_threshold = 2347;
9727
9728         SET_IEEE80211_DEV(priv->hw, &interface->dev);
9729         SET_IEEE80211_PERM_ADDR(hw, priv->mac_addr);
9730
9731         hw->extra_tx_headroom = priv->fops->tx_desc_size;
9732         ieee80211_hw_set(hw, SIGNAL_DBM);
9733         /*
9734          * The firmware handles rate control
9735          */
9736         ieee80211_hw_set(hw, HAS_RATE_CONTROL);
9737         ieee80211_hw_set(hw, AMPDU_AGGREGATION);
9738
9739         ret = ieee80211_register_hw(priv->hw);
9740         if (ret) {
9741                 dev_err(&udev->dev, "%s: Failed to register: %i\n",
9742                         __func__, ret);
9743                 goto exit;
9744         }
9745
9746 exit:
9747         if (ret < 0)
9748                 usb_put_dev(udev);
9749         return ret;
9750 }
9751
9752 static void rtl8xxxu_disconnect(struct usb_interface *interface)
9753 {
9754         struct rtl8xxxu_priv *priv;
9755         struct ieee80211_hw *hw;
9756
9757         hw = usb_get_intfdata(interface);
9758         priv = hw->priv;
9759
9760         rtl8xxxu_disable_device(hw);
9761         usb_set_intfdata(interface, NULL);
9762
9763         dev_info(&priv->udev->dev, "disconnecting\n");
9764
9765         ieee80211_unregister_hw(hw);
9766
9767         kfree(priv->fw_data);
9768         mutex_destroy(&priv->usb_buf_mutex);
9769         mutex_destroy(&priv->h2c_mutex);
9770
9771         usb_put_dev(priv->udev);
9772         ieee80211_free_hw(hw);
9773 }
9774
9775 static struct rtl8xxxu_fileops rtl8723au_fops = {
9776         .parse_efuse = rtl8723au_parse_efuse,
9777         .load_firmware = rtl8723au_load_firmware,
9778         .power_on = rtl8723au_power_on,
9779         .power_off = rtl8xxxu_power_off,
9780         .reset_8051 = rtl8xxxu_reset_8051,
9781         .llt_init = rtl8xxxu_init_llt_table,
9782         .phy_iq_calibrate = rtl8723au_phy_iq_calibrate,
9783         .config_channel = rtl8723au_config_channel,
9784         .parse_rx_desc = rtl8xxxu_parse_rxdesc16,
9785         .enable_rf = rtl8723a_enable_rf,
9786         .disable_rf = rtl8723a_disable_rf,
9787         .set_tx_power = rtl8723a_set_tx_power,
9788         .update_rate_mask = rtl8723au_update_rate_mask,
9789         .report_connect = rtl8723au_report_connect,
9790         .writeN_block_size = 1024,
9791         .mbox_ext_reg = REG_HMBOX_EXT_0,
9792         .mbox_ext_width = 2,
9793         .tx_desc_size = sizeof(struct rtl8xxxu_txdesc32),
9794         .rx_desc_size = sizeof(struct rtl8xxxu_rxdesc16),
9795         .adda_1t_init = 0x0b1b25a0,
9796         .adda_1t_path_on = 0x0bdb25a0,
9797         .adda_2t_path_on_a = 0x04db25a4,
9798         .adda_2t_path_on_b = 0x0b1b25a4,
9799         .mactable = rtl8723a_mac_init_table,
9800 };
9801
9802 static struct rtl8xxxu_fileops rtl8723bu_fops = {
9803         .parse_efuse = rtl8723bu_parse_efuse,
9804         .load_firmware = rtl8723bu_load_firmware,
9805         .power_on = rtl8723bu_power_on,
9806         .power_off = rtl8723bu_power_off,
9807         .reset_8051 = rtl8723bu_reset_8051,
9808         .llt_init = rtl8xxxu_auto_llt_table,
9809         .phy_init_antenna_selection = rtl8723bu_phy_init_antenna_selection,
9810         .phy_iq_calibrate = rtl8723bu_phy_iq_calibrate,
9811         .config_channel = rtl8723bu_config_channel,
9812         .parse_rx_desc = rtl8xxxu_parse_rxdesc24,
9813         .init_aggregation = rtl8723bu_init_aggregation,
9814         .init_statistics = rtl8723bu_init_statistics,
9815         .enable_rf = rtl8723b_enable_rf,
9816         .disable_rf = rtl8723b_disable_rf,
9817         .set_tx_power = rtl8723b_set_tx_power,
9818         .update_rate_mask = rtl8723bu_update_rate_mask,
9819         .report_connect = rtl8723bu_report_connect,
9820         .writeN_block_size = 1024,
9821         .mbox_ext_reg = REG_HMBOX_EXT0_8723B,
9822         .mbox_ext_width = 4,
9823         .tx_desc_size = sizeof(struct rtl8xxxu_txdesc40),
9824         .rx_desc_size = sizeof(struct rtl8xxxu_rxdesc24),
9825         .has_s0s1 = 1,
9826         .adda_1t_init = 0x01c00014,
9827         .adda_1t_path_on = 0x01c00014,
9828         .adda_2t_path_on_a = 0x01c00014,
9829         .adda_2t_path_on_b = 0x01c00014,
9830         .mactable = rtl8723b_mac_init_table,
9831 };
9832
9833 #ifdef CONFIG_RTL8XXXU_UNTESTED
9834
9835 static struct rtl8xxxu_fileops rtl8192cu_fops = {
9836         .parse_efuse = rtl8192cu_parse_efuse,
9837         .load_firmware = rtl8192cu_load_firmware,
9838         .power_on = rtl8192cu_power_on,
9839         .power_off = rtl8xxxu_power_off,
9840         .reset_8051 = rtl8xxxu_reset_8051,
9841         .llt_init = rtl8xxxu_init_llt_table,
9842         .phy_iq_calibrate = rtl8723au_phy_iq_calibrate,
9843         .config_channel = rtl8723au_config_channel,
9844         .parse_rx_desc = rtl8xxxu_parse_rxdesc16,
9845         .enable_rf = rtl8723a_enable_rf,
9846         .disable_rf = rtl8723a_disable_rf,
9847         .set_tx_power = rtl8723a_set_tx_power,
9848         .update_rate_mask = rtl8723au_update_rate_mask,
9849         .report_connect = rtl8723au_report_connect,
9850         .writeN_block_size = 128,
9851         .mbox_ext_reg = REG_HMBOX_EXT_0,
9852         .mbox_ext_width = 2,
9853         .tx_desc_size = sizeof(struct rtl8xxxu_txdesc32),
9854         .rx_desc_size = sizeof(struct rtl8xxxu_rxdesc16),
9855         .adda_1t_init = 0x0b1b25a0,
9856         .adda_1t_path_on = 0x0bdb25a0,
9857         .adda_2t_path_on_a = 0x04db25a4,
9858         .adda_2t_path_on_b = 0x0b1b25a4,
9859         .mactable = rtl8723a_mac_init_table,
9860 };
9861
9862 #endif
9863
9864 static struct rtl8xxxu_fileops rtl8192eu_fops = {
9865         .parse_efuse = rtl8192eu_parse_efuse,
9866         .load_firmware = rtl8192eu_load_firmware,
9867         .power_on = rtl8192eu_power_on,
9868         .power_off = rtl8xxxu_power_off,
9869         .reset_8051 = rtl8xxxu_reset_8051,
9870         .llt_init = rtl8xxxu_auto_llt_table,
9871         .phy_iq_calibrate = rtl8192eu_phy_iq_calibrate,
9872         .config_channel = rtl8723bu_config_channel,
9873         .parse_rx_desc = rtl8xxxu_parse_rxdesc24,
9874         .enable_rf = rtl8723b_enable_rf,
9875         .disable_rf = rtl8723b_disable_rf,
9876         .set_tx_power = rtl8192e_set_tx_power,
9877         .update_rate_mask = rtl8723bu_update_rate_mask,
9878         .report_connect = rtl8723bu_report_connect,
9879         .writeN_block_size = 128,
9880         .mbox_ext_reg = REG_HMBOX_EXT0_8723B,
9881         .mbox_ext_width = 4,
9882         .tx_desc_size = sizeof(struct rtl8xxxu_txdesc40),
9883         .rx_desc_size = sizeof(struct rtl8xxxu_rxdesc24),
9884         .has_s0s1 = 0,
9885         .adda_1t_init = 0x0fc01616,
9886         .adda_1t_path_on = 0x0fc01616,
9887         .adda_2t_path_on_a = 0x0fc01616,
9888         .adda_2t_path_on_b = 0x0fc01616,
9889         .mactable = rtl8192e_mac_init_table,
9890         .total_page_num = TX_TOTAL_PAGE_NUM_8192E,
9891         .page_num_hi = TX_PAGE_NUM_HI_PQ_8192E,
9892         .page_num_lo = TX_PAGE_NUM_LO_PQ_8192E,
9893         .page_num_norm = TX_PAGE_NUM_NORM_PQ_8192E,
9894 };
9895
9896 static struct usb_device_id dev_table[] = {
9897 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x8724, 0xff, 0xff, 0xff),
9898         .driver_info = (unsigned long)&rtl8723au_fops},
9899 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x1724, 0xff, 0xff, 0xff),
9900         .driver_info = (unsigned long)&rtl8723au_fops},
9901 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x0724, 0xff, 0xff, 0xff),
9902         .driver_info = (unsigned long)&rtl8723au_fops},
9903 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x818b, 0xff, 0xff, 0xff),
9904         .driver_info = (unsigned long)&rtl8192eu_fops},
9905 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0xb720, 0xff, 0xff, 0xff),
9906         .driver_info = (unsigned long)&rtl8723bu_fops},
9907 #ifdef CONFIG_RTL8XXXU_UNTESTED
9908 /* Still supported by rtlwifi */
9909 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x8176, 0xff, 0xff, 0xff),
9910         .driver_info = (unsigned long)&rtl8192cu_fops},
9911 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x8178, 0xff, 0xff, 0xff),
9912         .driver_info = (unsigned long)&rtl8192cu_fops},
9913 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x817f, 0xff, 0xff, 0xff),
9914         .driver_info = (unsigned long)&rtl8192cu_fops},
9915 /* Tested by Larry Finger */
9916 {USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0x7811, 0xff, 0xff, 0xff),
9917         .driver_info = (unsigned long)&rtl8192cu_fops},
9918 /* Currently untested 8188 series devices */
9919 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x8191, 0xff, 0xff, 0xff),
9920         .driver_info = (unsigned long)&rtl8192cu_fops},
9921 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x8170, 0xff, 0xff, 0xff),
9922         .driver_info = (unsigned long)&rtl8192cu_fops},
9923 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x8177, 0xff, 0xff, 0xff),
9924         .driver_info = (unsigned long)&rtl8192cu_fops},
9925 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x817a, 0xff, 0xff, 0xff),
9926         .driver_info = (unsigned long)&rtl8192cu_fops},
9927 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x817b, 0xff, 0xff, 0xff),
9928         .driver_info = (unsigned long)&rtl8192cu_fops},
9929 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x817d, 0xff, 0xff, 0xff),
9930         .driver_info = (unsigned long)&rtl8192cu_fops},
9931 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x817e, 0xff, 0xff, 0xff),
9932         .driver_info = (unsigned long)&rtl8192cu_fops},
9933 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x818a, 0xff, 0xff, 0xff),
9934         .driver_info = (unsigned long)&rtl8192cu_fops},
9935 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x317f, 0xff, 0xff, 0xff),
9936         .driver_info = (unsigned long)&rtl8192cu_fops},
9937 {USB_DEVICE_AND_INTERFACE_INFO(0x1058, 0x0631, 0xff, 0xff, 0xff),
9938         .driver_info = (unsigned long)&rtl8192cu_fops},
9939 {USB_DEVICE_AND_INTERFACE_INFO(0x04bb, 0x094c, 0xff, 0xff, 0xff),
9940         .driver_info = (unsigned long)&rtl8192cu_fops},
9941 {USB_DEVICE_AND_INTERFACE_INFO(0x050d, 0x1102, 0xff, 0xff, 0xff),
9942         .driver_info = (unsigned long)&rtl8192cu_fops},
9943 {USB_DEVICE_AND_INTERFACE_INFO(0x06f8, 0xe033, 0xff, 0xff, 0xff),
9944         .driver_info = (unsigned long)&rtl8192cu_fops},
9945 {USB_DEVICE_AND_INTERFACE_INFO(0x07b8, 0x8189, 0xff, 0xff, 0xff),
9946         .driver_info = (unsigned long)&rtl8192cu_fops},
9947 {USB_DEVICE_AND_INTERFACE_INFO(0x0846, 0x9041, 0xff, 0xff, 0xff),
9948         .driver_info = (unsigned long)&rtl8192cu_fops},
9949 {USB_DEVICE_AND_INTERFACE_INFO(0x0b05, 0x17ba, 0xff, 0xff, 0xff),
9950         .driver_info = (unsigned long)&rtl8192cu_fops},
9951 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x1e1e, 0xff, 0xff, 0xff),
9952         .driver_info = (unsigned long)&rtl8192cu_fops},
9953 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x5088, 0xff, 0xff, 0xff),
9954         .driver_info = (unsigned long)&rtl8192cu_fops},
9955 {USB_DEVICE_AND_INTERFACE_INFO(0x0df6, 0x0052, 0xff, 0xff, 0xff),
9956         .driver_info = (unsigned long)&rtl8192cu_fops},
9957 {USB_DEVICE_AND_INTERFACE_INFO(0x0df6, 0x005c, 0xff, 0xff, 0xff),
9958         .driver_info = (unsigned long)&rtl8192cu_fops},
9959 {USB_DEVICE_AND_INTERFACE_INFO(0x0eb0, 0x9071, 0xff, 0xff, 0xff),
9960         .driver_info = (unsigned long)&rtl8192cu_fops},
9961 {USB_DEVICE_AND_INTERFACE_INFO(0x103c, 0x1629, 0xff, 0xff, 0xff),
9962         .driver_info = (unsigned long)&rtl8192cu_fops},
9963 {USB_DEVICE_AND_INTERFACE_INFO(0x13d3, 0x3357, 0xff, 0xff, 0xff),
9964         .driver_info = (unsigned long)&rtl8192cu_fops},
9965 {USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x3308, 0xff, 0xff, 0xff),
9966         .driver_info = (unsigned long)&rtl8192cu_fops},
9967 {USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x330b, 0xff, 0xff, 0xff),
9968         .driver_info = (unsigned long)&rtl8192cu_fops},
9969 {USB_DEVICE_AND_INTERFACE_INFO(0x2019, 0x4902, 0xff, 0xff, 0xff),
9970         .driver_info = (unsigned long)&rtl8192cu_fops},
9971 {USB_DEVICE_AND_INTERFACE_INFO(0x2019, 0xab2a, 0xff, 0xff, 0xff),
9972         .driver_info = (unsigned long)&rtl8192cu_fops},
9973 {USB_DEVICE_AND_INTERFACE_INFO(0x2019, 0xab2e, 0xff, 0xff, 0xff),
9974         .driver_info = (unsigned long)&rtl8192cu_fops},
9975 {USB_DEVICE_AND_INTERFACE_INFO(0x2019, 0xed17, 0xff, 0xff, 0xff),
9976         .driver_info = (unsigned long)&rtl8192cu_fops},
9977 {USB_DEVICE_AND_INTERFACE_INFO(0x20f4, 0x648b, 0xff, 0xff, 0xff),
9978         .driver_info = (unsigned long)&rtl8192cu_fops},
9979 {USB_DEVICE_AND_INTERFACE_INFO(0x4855, 0x0090, 0xff, 0xff, 0xff),
9980         .driver_info = (unsigned long)&rtl8192cu_fops},
9981 {USB_DEVICE_AND_INTERFACE_INFO(0x4856, 0x0091, 0xff, 0xff, 0xff),
9982         .driver_info = (unsigned long)&rtl8192cu_fops},
9983 {USB_DEVICE_AND_INTERFACE_INFO(0xcdab, 0x8010, 0xff, 0xff, 0xff),
9984         .driver_info = (unsigned long)&rtl8192cu_fops},
9985 {USB_DEVICE_AND_INTERFACE_INFO(0x04f2, 0xaff7, 0xff, 0xff, 0xff),
9986         .driver_info = (unsigned long)&rtl8192cu_fops},
9987 {USB_DEVICE_AND_INTERFACE_INFO(0x04f2, 0xaff9, 0xff, 0xff, 0xff),
9988         .driver_info = (unsigned long)&rtl8192cu_fops},
9989 {USB_DEVICE_AND_INTERFACE_INFO(0x04f2, 0xaffa, 0xff, 0xff, 0xff),
9990         .driver_info = (unsigned long)&rtl8192cu_fops},
9991 {USB_DEVICE_AND_INTERFACE_INFO(0x04f2, 0xaff8, 0xff, 0xff, 0xff),
9992         .driver_info = (unsigned long)&rtl8192cu_fops},
9993 {USB_DEVICE_AND_INTERFACE_INFO(0x04f2, 0xaffb, 0xff, 0xff, 0xff),
9994         .driver_info = (unsigned long)&rtl8192cu_fops},
9995 {USB_DEVICE_AND_INTERFACE_INFO(0x04f2, 0xaffc, 0xff, 0xff, 0xff),
9996         .driver_info = (unsigned long)&rtl8192cu_fops},
9997 {USB_DEVICE_AND_INTERFACE_INFO(0x2019, 0x1201, 0xff, 0xff, 0xff),
9998         .driver_info = (unsigned long)&rtl8192cu_fops},
9999 /* Currently untested 8192 series devices */
10000 {USB_DEVICE_AND_INTERFACE_INFO(0x04bb, 0x0950, 0xff, 0xff, 0xff),
10001         .driver_info = (unsigned long)&rtl8192cu_fops},
10002 {USB_DEVICE_AND_INTERFACE_INFO(0x050d, 0x1004, 0xff, 0xff, 0xff),
10003         .driver_info = (unsigned long)&rtl8192cu_fops},
10004 {USB_DEVICE_AND_INTERFACE_INFO(0x050d, 0x2102, 0xff, 0xff, 0xff),
10005         .driver_info = (unsigned long)&rtl8192cu_fops},
10006 {USB_DEVICE_AND_INTERFACE_INFO(0x050d, 0x2103, 0xff, 0xff, 0xff),
10007         .driver_info = (unsigned long)&rtl8192cu_fops},
10008 {USB_DEVICE_AND_INTERFACE_INFO(0x0586, 0x341f, 0xff, 0xff, 0xff),
10009         .driver_info = (unsigned long)&rtl8192cu_fops},
10010 {USB_DEVICE_AND_INTERFACE_INFO(0x06f8, 0xe035, 0xff, 0xff, 0xff),
10011         .driver_info = (unsigned long)&rtl8192cu_fops},
10012 {USB_DEVICE_AND_INTERFACE_INFO(0x0b05, 0x17ab, 0xff, 0xff, 0xff),
10013         .driver_info = (unsigned long)&rtl8192cu_fops},
10014 {USB_DEVICE_AND_INTERFACE_INFO(0x0df6, 0x0061, 0xff, 0xff, 0xff),
10015         .driver_info = (unsigned long)&rtl8192cu_fops},
10016 {USB_DEVICE_AND_INTERFACE_INFO(0x0df6, 0x0070, 0xff, 0xff, 0xff),
10017         .driver_info = (unsigned long)&rtl8192cu_fops},
10018 {USB_DEVICE_AND_INTERFACE_INFO(0x0789, 0x016d, 0xff, 0xff, 0xff),
10019         .driver_info = (unsigned long)&rtl8192cu_fops},
10020 {USB_DEVICE_AND_INTERFACE_INFO(0x07aa, 0x0056, 0xff, 0xff, 0xff),
10021         .driver_info = (unsigned long)&rtl8192cu_fops},
10022 {USB_DEVICE_AND_INTERFACE_INFO(0x07b8, 0x8178, 0xff, 0xff, 0xff),
10023         .driver_info = (unsigned long)&rtl8192cu_fops},
10024 {USB_DEVICE_AND_INTERFACE_INFO(0x0846, 0x9021, 0xff, 0xff, 0xff),
10025         .driver_info = (unsigned long)&rtl8192cu_fops},
10026 {USB_DEVICE_AND_INTERFACE_INFO(0x0846, 0xf001, 0xff, 0xff, 0xff),
10027         .driver_info = (unsigned long)&rtl8192cu_fops},
10028 {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_REALTEK, 0x2e2e, 0xff, 0xff, 0xff),
10029         .driver_info = (unsigned long)&rtl8192cu_fops},
10030 {USB_DEVICE_AND_INTERFACE_INFO(0x0e66, 0x0019, 0xff, 0xff, 0xff),
10031         .driver_info = (unsigned long)&rtl8192cu_fops},
10032 {USB_DEVICE_AND_INTERFACE_INFO(0x0e66, 0x0020, 0xff, 0xff, 0xff),
10033         .driver_info = (unsigned long)&rtl8192cu_fops},
10034 {USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x3307, 0xff, 0xff, 0xff),
10035         .driver_info = (unsigned long)&rtl8192cu_fops},
10036 {USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x3309, 0xff, 0xff, 0xff),
10037         .driver_info = (unsigned long)&rtl8192cu_fops},
10038 {USB_DEVICE_AND_INTERFACE_INFO(0x2001, 0x330a, 0xff, 0xff, 0xff),
10039         .driver_info = (unsigned long)&rtl8192cu_fops},
10040 {USB_DEVICE_AND_INTERFACE_INFO(0x2019, 0xab2b, 0xff, 0xff, 0xff),
10041         .driver_info = (unsigned long)&rtl8192cu_fops},
10042 {USB_DEVICE_AND_INTERFACE_INFO(0x20f4, 0x624d, 0xff, 0xff, 0xff),
10043         .driver_info = (unsigned long)&rtl8192cu_fops},
10044 {USB_DEVICE_AND_INTERFACE_INFO(0x2357, 0x0100, 0xff, 0xff, 0xff),
10045         .driver_info = (unsigned long)&rtl8192cu_fops},
10046 {USB_DEVICE_AND_INTERFACE_INFO(0x4855, 0x0091, 0xff, 0xff, 0xff),
10047         .driver_info = (unsigned long)&rtl8192cu_fops},
10048 {USB_DEVICE_AND_INTERFACE_INFO(0x7392, 0x7822, 0xff, 0xff, 0xff),
10049         .driver_info = (unsigned long)&rtl8192cu_fops},
10050 #endif
10051 { }
10052 };
10053
10054 static struct usb_driver rtl8xxxu_driver = {
10055         .name = DRIVER_NAME,
10056         .probe = rtl8xxxu_probe,
10057         .disconnect = rtl8xxxu_disconnect,
10058         .id_table = dev_table,
10059         .disable_hub_initiated_lpm = 1,
10060 };
10061
10062 static int __init rtl8xxxu_module_init(void)
10063 {
10064         int res;
10065
10066         res = usb_register(&rtl8xxxu_driver);
10067         if (res < 0)
10068                 pr_err(DRIVER_NAME ": usb_register() failed (%i)\n", res);
10069
10070         return res;
10071 }
10072
10073 static void __exit rtl8xxxu_module_exit(void)
10074 {
10075         usb_deregister(&rtl8xxxu_driver);
10076 }
10077
10078
10079 MODULE_DEVICE_TABLE(usb, dev_table);
10080
10081 module_init(rtl8xxxu_module_init);
10082 module_exit(rtl8xxxu_module_exit);