1c98411dcSBitterblue Smith // SPDX-License-Identifier: GPL-2.0-only
2c98411dcSBitterblue Smith /*
3c98411dcSBitterblue Smith * RTL8XXXU mac80211 USB driver - 8192fu specific subdriver
4c98411dcSBitterblue Smith *
5c98411dcSBitterblue Smith * Copyright (c) 2023 Bitterblue Smith <rtl8821cerfe2@gmail.com>
6c98411dcSBitterblue Smith *
7c98411dcSBitterblue Smith * Portions copied from existing rtl8xxxu code:
8c98411dcSBitterblue Smith * Copyright (c) 2014 - 2017 Jes Sorensen <Jes.Sorensen@gmail.com>
9c98411dcSBitterblue Smith *
10c98411dcSBitterblue Smith * Portions, notably calibration code:
11c98411dcSBitterblue Smith * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
12c98411dcSBitterblue Smith */
13c98411dcSBitterblue Smith
14c98411dcSBitterblue Smith #include <linux/init.h>
15c98411dcSBitterblue Smith #include <linux/kernel.h>
16c98411dcSBitterblue Smith #include <linux/sched.h>
17c98411dcSBitterblue Smith #include <linux/errno.h>
18c98411dcSBitterblue Smith #include <linux/slab.h>
19c98411dcSBitterblue Smith #include <linux/module.h>
20c98411dcSBitterblue Smith #include <linux/spinlock.h>
21c98411dcSBitterblue Smith #include <linux/list.h>
22c98411dcSBitterblue Smith #include <linux/usb.h>
23c98411dcSBitterblue Smith #include <linux/netdevice.h>
24c98411dcSBitterblue Smith #include <linux/etherdevice.h>
25c98411dcSBitterblue Smith #include <linux/ethtool.h>
26c98411dcSBitterblue Smith #include <linux/wireless.h>
27c98411dcSBitterblue Smith #include <linux/firmware.h>
28c98411dcSBitterblue Smith #include <linux/moduleparam.h>
29c98411dcSBitterblue Smith #include <net/mac80211.h>
30c98411dcSBitterblue Smith #include "rtl8xxxu.h"
31c98411dcSBitterblue Smith #include "rtl8xxxu_regs.h"
32c98411dcSBitterblue Smith
33c98411dcSBitterblue Smith static const struct rtl8xxxu_reg8val rtl8192f_mac_init_table[] = {
34c98411dcSBitterblue Smith {0x420, 0x00}, {0x422, 0x78}, {0x428, 0x0a}, {0x429, 0x10},
35c98411dcSBitterblue Smith {0x430, 0x00}, {0x431, 0x00}, {0x432, 0x00}, {0x433, 0x01},
36c98411dcSBitterblue Smith {0x434, 0x04}, {0x435, 0x05}, {0x436, 0x07}, {0x437, 0x08},
37c98411dcSBitterblue Smith {0x43c, 0x04}, {0x43d, 0x05}, {0x43e, 0x07}, {0x43f, 0x08},
38c98411dcSBitterblue Smith {0x440, 0x5d}, {0x441, 0x01}, {0x442, 0x00}, {0x444, 0x10},
39c98411dcSBitterblue Smith {0x445, 0xf0}, {0x446, 0x0e}, {0x447, 0x1f}, {0x448, 0x00},
40c98411dcSBitterblue Smith {0x449, 0x00}, {0x44a, 0x00}, {0x44b, 0x00}, {0x44c, 0x10},
41c98411dcSBitterblue Smith {0x44d, 0xf0}, {0x44e, 0x0e}, {0x44f, 0x00}, {0x450, 0x00},
42c98411dcSBitterblue Smith {0x451, 0x00}, {0x452, 0x00}, {0x453, 0x00}, {0x480, 0x20},
43c98411dcSBitterblue Smith {0x49c, 0x30}, {0x49d, 0xf0}, {0x49e, 0x03}, {0x49f, 0x3e},
44c98411dcSBitterblue Smith {0x4a0, 0x00}, {0x4a1, 0x00}, {0x4a2, 0x00}, {0x4a3, 0x00},
45c98411dcSBitterblue Smith {0x4a4, 0x15}, {0x4a5, 0xf0}, {0x4a6, 0x01}, {0x4a7, 0x0e},
46c98411dcSBitterblue Smith {0x4a8, 0xe0}, {0x4a9, 0x00}, {0x4aa, 0x00}, {0x4ab, 0x00},
47c98411dcSBitterblue Smith {0x2448, 0x06}, {0x244a, 0x06}, {0x244c, 0x06}, {0x244e, 0x06},
48c98411dcSBitterblue Smith {0x4c7, 0x80}, {0x4c8, 0xff}, {0x4c9, 0x08}, {0x4ca, 0x3c},
49c98411dcSBitterblue Smith {0x4cb, 0x3c}, {0x4cc, 0xff}, {0x4cd, 0xff}, {0x4ce, 0x01},
50c98411dcSBitterblue Smith {0x500, 0x26}, {0x501, 0xa2}, {0x502, 0x2f}, {0x503, 0x00},
51c98411dcSBitterblue Smith {0x504, 0x28}, {0x505, 0xa3}, {0x506, 0x5e}, {0x507, 0x00},
52c98411dcSBitterblue Smith {0x508, 0x2b}, {0x509, 0xa4}, {0x50a, 0x5e}, {0x50b, 0x00},
53c98411dcSBitterblue Smith {0x50c, 0x4f}, {0x50d, 0xa4}, {0x50e, 0x00}, {0x50f, 0x00},
54c98411dcSBitterblue Smith {0x512, 0x1c}, {0x514, 0x0a}, {0x516, 0x0a}, {0x521, 0x2f},
55c98411dcSBitterblue Smith {0x525, 0x0f}, {0x550, 0x10}, {0x551, 0x10}, {0x559, 0x02},
56c98411dcSBitterblue Smith {0x55c, 0x50}, {0x55d, 0xff}, {0x605, 0x30}, {0x608, 0x0e},
57c98411dcSBitterblue Smith {0x609, 0x2a}, {0x60c, 0x18}, {0x620, 0xff}, {0x621, 0xff},
58c98411dcSBitterblue Smith {0x622, 0xff}, {0x623, 0xff}, {0x624, 0xff}, {0x625, 0xff},
59c98411dcSBitterblue Smith {0x626, 0xff}, {0x627, 0xff}, {0x638, 0x50}, {0x63c, 0x0a},
60c98411dcSBitterblue Smith {0x63d, 0x0a}, {0x63e, 0x0e}, {0x63f, 0x0e}, {0x640, 0x40},
61c98411dcSBitterblue Smith {0x642, 0x40}, {0x643, 0x00}, {0x652, 0xc8}, {0x66e, 0x05},
62c98411dcSBitterblue Smith {0x6a0, 0xff}, {0x6a1, 0xff}, {0x6a2, 0xff}, {0x6a3, 0xff},
63c98411dcSBitterblue Smith {0x6a4, 0xff}, {0x6a5, 0xff}, {0x6de, 0x84}, {0x700, 0x21},
64c98411dcSBitterblue Smith {0x701, 0x43}, {0x702, 0x65}, {0x703, 0x87}, {0x708, 0x21},
65c98411dcSBitterblue Smith {0x709, 0x43}, {0x70a, 0x65}, {0x70b, 0x87}, {0x718, 0x40},
66c98411dcSBitterblue Smith {0x7c0, 0x38}, {0x7c2, 0x0f}, {0x7c3, 0xc0}, {0x073, 0x04},
67c98411dcSBitterblue Smith {0x7c4, 0x77}, {0x024, 0xc7}, {0x7ec, 0xff}, {0x7ed, 0xff},
68c98411dcSBitterblue Smith {0x7ee, 0xff}, {0x7ef, 0xff},
69c98411dcSBitterblue Smith {0xffff, 0xff},
70c98411dcSBitterblue Smith };
71c98411dcSBitterblue Smith
72c98411dcSBitterblue Smith /* If updating the phy init table, also update rtl8192f_revise_cck_tx_psf(). */
73c98411dcSBitterblue Smith static const struct rtl8xxxu_reg32val rtl8192fu_phy_init_table[] = {
74c98411dcSBitterblue Smith {0x800, 0x80006C00}, {0x804, 0x00004001},
75c98411dcSBitterblue Smith {0x808, 0x0000FC00}, {0x80C, 0x00000000},
76c98411dcSBitterblue Smith {0x810, 0x20200322}, {0x814, 0x020C3910},
77c98411dcSBitterblue Smith {0x818, 0x00000385}, {0x81C, 0x07000000},
78c98411dcSBitterblue Smith {0x820, 0x01000100}, {0x824, 0x00390204},
79c98411dcSBitterblue Smith {0x828, 0x01000100}, {0x82C, 0x00390204},
80c98411dcSBitterblue Smith {0x830, 0x25252525}, {0x834, 0x25252525},
81c98411dcSBitterblue Smith {0x838, 0x25252525}, {0x83C, 0x25252525},
82c98411dcSBitterblue Smith {0x840, 0x00010000}, {0x844, 0x00010000},
83c98411dcSBitterblue Smith {0x848, 0x25252525}, {0x84C, 0x25252525},
84c98411dcSBitterblue Smith {0x850, 0x00031FE0}, {0x854, 0x00000000},
85c98411dcSBitterblue Smith {0x858, 0x569A569A}, {0x85C, 0x00400040},
86c98411dcSBitterblue Smith {0x860, 0x66F60000}, {0x864, 0x061F0000},
87c98411dcSBitterblue Smith {0x868, 0x25252525}, {0x86C, 0x25252525},
88c98411dcSBitterblue Smith {0x870, 0x00000300}, {0x874, 0x04003400},
89c98411dcSBitterblue Smith {0x878, 0x08080808}, {0x87C, 0x004F0201},
90c98411dcSBitterblue Smith {0x880, 0xD8001402}, {0x884, 0xC0000120},
91c98411dcSBitterblue Smith {0x888, 0x00000000}, {0x88C, 0xCC0000C0},
92c98411dcSBitterblue Smith {0x890, 0x00000000}, {0x894, 0xFFFFFFFE},
93c98411dcSBitterblue Smith {0x898, 0x40302010}, {0x89C, 0x00706050},
94c98411dcSBitterblue Smith {0x900, 0x00000000}, {0x904, 0x00000023},
95c98411dcSBitterblue Smith {0x908, 0x00000F00}, {0x90C, 0x81121313},
96c98411dcSBitterblue Smith {0x910, 0x024C0000}, {0x914, 0x00000000},
97c98411dcSBitterblue Smith {0x918, 0x00000000}, {0x91C, 0x00000000},
98c98411dcSBitterblue Smith {0x920, 0x00000000}, {0x924, 0x00000000},
99c98411dcSBitterblue Smith {0x928, 0x00000000}, {0x92C, 0x00000000},
100c98411dcSBitterblue Smith {0x930, 0x88000000}, {0x934, 0x00000245},
101c98411dcSBitterblue Smith {0x938, 0x00024588}, {0x93C, 0x00000000},
102c98411dcSBitterblue Smith {0x940, 0x000007FF}, {0x944, 0x3F3F0000},
103c98411dcSBitterblue Smith {0x948, 0x000001A3}, {0x94C, 0x20200008},
104c98411dcSBitterblue Smith {0x950, 0x00338A98}, {0x954, 0x00000000},
105c98411dcSBitterblue Smith {0x958, 0xCBCAD87A}, {0x95C, 0x06EB5735},
106c98411dcSBitterblue Smith {0x960, 0x00000000}, {0x964, 0x00000000},
107c98411dcSBitterblue Smith {0x968, 0x00000000}, {0x96C, 0x00000003},
108c98411dcSBitterblue Smith {0x970, 0x00000000}, {0x974, 0x00000000},
109c98411dcSBitterblue Smith {0x978, 0x00000000}, {0x97C, 0x10030000},
110c98411dcSBitterblue Smith {0x980, 0x00000000}, {0x984, 0x02800280},
111c98411dcSBitterblue Smith {0x988, 0x020A5704}, {0x98C, 0x1461C826},
112c98411dcSBitterblue Smith {0x990, 0x0001469E}, {0x994, 0x008858D1},
113c98411dcSBitterblue Smith {0x998, 0x400086C9}, {0x99C, 0x44444242},
114c98411dcSBitterblue Smith {0x9A0, 0x00000000}, {0x9A4, 0x00000000},
115c98411dcSBitterblue Smith {0x9A8, 0x00000000}, {0x9AC, 0xC0000000},
116c98411dcSBitterblue Smith {0xA00, 0x00D047C8}, {0xA04, 0xC1FF0008},
117c98411dcSBitterblue Smith {0xA08, 0x88838300}, {0xA0C, 0x2E20100F},
118c98411dcSBitterblue Smith {0xA10, 0x9500BB78}, {0xA14, 0x11144028},
119c98411dcSBitterblue Smith {0xA18, 0x00881117}, {0xA1C, 0x89140F00},
120c98411dcSBitterblue Smith {0xA20, 0xE82C0001}, {0xA24, 0x64B80C1C},
121c98411dcSBitterblue Smith {0xA28, 0x00158810}, {0xA2C, 0x10BB8000},
122c98411dcSBitterblue Smith {0xA70, 0x00008000}, {0xA74, 0x80800100},
123c98411dcSBitterblue Smith {0xA78, 0x000089F0}, {0xA7C, 0x225B0606},
124c98411dcSBitterblue Smith {0xA80, 0x20803210}, {0xA84, 0x00200200},
125c98411dcSBitterblue Smith {0xA88, 0x00000000}, {0xA8C, 0x00000000},
126c98411dcSBitterblue Smith {0xA90, 0x00000000}, {0xA94, 0x00000000},
127c98411dcSBitterblue Smith {0xA98, 0x00000000}, {0xA9C, 0x00460000},
128c98411dcSBitterblue Smith {0xAA0, 0x00000000}, {0xAA4, 0x00020014},
129c98411dcSBitterblue Smith {0xAA8, 0xBA0A0008}, {0xAAC, 0x01235667},
130c98411dcSBitterblue Smith {0xAB0, 0x00000000}, {0xAB4, 0x00201402},
131c98411dcSBitterblue Smith {0xAB8, 0x0000001C}, {0xABC, 0x0000F7FF},
132c98411dcSBitterblue Smith {0xAC0, 0xD4C0A742}, {0xAC4, 0x00000000},
133c98411dcSBitterblue Smith {0xAC8, 0x00000F08}, {0xACC, 0x00000F07},
134c98411dcSBitterblue Smith {0xAD0, 0xA1052A10}, {0xAD4, 0x0D9D8452},
135c98411dcSBitterblue Smith {0xAD8, 0x9E024024}, {0xADC, 0x0023C001},
136c98411dcSBitterblue Smith {0xAE0, 0x00000391}, {0xB2C, 0x00000000},
137c98411dcSBitterblue Smith {0xC00, 0x00000080}, {0xC04, 0x6F005433},
138c98411dcSBitterblue Smith {0xC08, 0x000004E4}, {0xC0C, 0x6C6C6C6C},
139c98411dcSBitterblue Smith {0xC10, 0x22000000}, {0xC14, 0x40000100},
140c98411dcSBitterblue Smith {0xC18, 0x22000000}, {0xC1C, 0x40000100},
141c98411dcSBitterblue Smith {0xC20, 0x00000000}, {0xC24, 0x40000100},
142c98411dcSBitterblue Smith {0xC28, 0x00000000}, {0xC2C, 0x40000100},
143c98411dcSBitterblue Smith {0xC30, 0x0401E809}, {0xC34, 0x30000020},
144c98411dcSBitterblue Smith {0xC38, 0x23808080}, {0xC3C, 0x00002F44},
145c98411dcSBitterblue Smith {0xC40, 0x1CF8403F}, {0xC44, 0x000100C7},
146c98411dcSBitterblue Smith {0xC48, 0xEC060106}, {0xC4C, 0x007F037F},
147c98411dcSBitterblue Smith {0xC50, 0x00E48020}, {0xC54, 0x04008017},
148c98411dcSBitterblue Smith {0xC58, 0x00000020}, {0xC5C, 0x00708492},
149c98411dcSBitterblue Smith {0xC60, 0x09280200}, {0xC64, 0x5014838B},
150c98411dcSBitterblue Smith {0xC68, 0x47C006C7}, {0xC6C, 0x00000035},
151c98411dcSBitterblue Smith {0xC70, 0x00001007}, {0xC74, 0x02815269},
152c98411dcSBitterblue Smith {0xC78, 0x0FE07F1F}, {0xC7C, 0x00B91612},
153c98411dcSBitterblue Smith {0xC80, 0x40000100}, {0xC84, 0x32000000},
154c98411dcSBitterblue Smith {0xC88, 0x40000100}, {0xC8C, 0xA0240000},
155c98411dcSBitterblue Smith {0xC90, 0x400E161E}, {0xC94, 0x00000F00},
156c98411dcSBitterblue Smith {0xC98, 0x400E161E}, {0xC9C, 0x0000BDC8},
157c98411dcSBitterblue Smith {0xCA0, 0x00000000}, {0xCA4, 0x098300A0},
158c98411dcSBitterblue Smith {0xCA8, 0x00006B00}, {0xCAC, 0x87F45B1A},
159c98411dcSBitterblue Smith {0xCB0, 0x0000002D}, {0xCB4, 0x00000000},
160c98411dcSBitterblue Smith {0xCB8, 0x00000000}, {0xCBC, 0x28100200},
161c98411dcSBitterblue Smith {0xCC0, 0x0010A3D0}, {0xCC4, 0x00000F7D},
162c98411dcSBitterblue Smith {0xCC8, 0x00000000}, {0xCCC, 0x00000000},
163c98411dcSBitterblue Smith {0xCD0, 0x593659AD}, {0xCD4, 0xB7545121},
164c98411dcSBitterblue Smith {0xCD8, 0x64B22427}, {0xCDC, 0x00766932},
165c98411dcSBitterblue Smith {0xCE0, 0x40201000}, {0xCE4, 0x00000000},
166c98411dcSBitterblue Smith {0xCE8, 0x40E04407}, {0xCEC, 0x2E572000},
167c98411dcSBitterblue Smith {0xD00, 0x000D8780}, {0xD04, 0x40020403},
168c98411dcSBitterblue Smith {0xD08, 0x0002907F}, {0xD0C, 0x20010201},
169c98411dcSBitterblue Smith {0xD10, 0x06288888}, {0xD14, 0x8888367B},
170c98411dcSBitterblue Smith {0xD18, 0x7D806DB3}, {0xD1C, 0x0000007F},
171c98411dcSBitterblue Smith {0xD20, 0x567600B8}, {0xD24, 0x0000018B},
172c98411dcSBitterblue Smith {0xD28, 0xD513FF7D}, {0xD2C, 0xCC979975},
173c98411dcSBitterblue Smith {0xD30, 0x04928000}, {0xD34, 0x40608000},
174c98411dcSBitterblue Smith {0xD38, 0x88DDA000}, {0xD3C, 0x00026EE2},
175c98411dcSBitterblue Smith {0xD50, 0x67270001}, {0xD54, 0x20500000},
176c98411dcSBitterblue Smith {0xD58, 0x16161616}, {0xD5C, 0x71F20064},
177c98411dcSBitterblue Smith {0xD60, 0x4653DA60}, {0xD64, 0x3E718A3C},
178c98411dcSBitterblue Smith {0xD68, 0x00000183}, {0xD7C, 0x00000000},
179c98411dcSBitterblue Smith {0xD80, 0x50000000}, {0xD84, 0x31310400},
180c98411dcSBitterblue Smith {0xD88, 0xF5B50000}, {0xD8C, 0x00000000},
181c98411dcSBitterblue Smith {0xD90, 0x00000000}, {0xD94, 0x44BBBB44},
182c98411dcSBitterblue Smith {0xD98, 0x44BB44FF}, {0xD9C, 0x06033688},
183c98411dcSBitterblue Smith {0xE00, 0x25252525}, {0xE04, 0x25252525},
184c98411dcSBitterblue Smith {0xE08, 0x25252525}, {0xE10, 0x25252525},
185c98411dcSBitterblue Smith {0xE14, 0x25252525}, {0xE18, 0x25252525},
186c98411dcSBitterblue Smith {0xE1C, 0x25252525}, {0xE20, 0x00000000},
187c98411dcSBitterblue Smith {0xE24, 0x00200000}, {0xE28, 0x00000000},
188c98411dcSBitterblue Smith {0xE2C, 0x00000000}, {0xE30, 0x01007C00},
189c98411dcSBitterblue Smith {0xE34, 0x01004800}, {0xE38, 0x10008C0F},
190c98411dcSBitterblue Smith {0xE3C, 0x3C008C0F}, {0xE40, 0x01007C00},
191c98411dcSBitterblue Smith {0xE44, 0x00000000}, {0xE48, 0x00000000},
192c98411dcSBitterblue Smith {0xE4C, 0x00000000}, {0xE50, 0x01007C00},
193c98411dcSBitterblue Smith {0xE54, 0x01004800}, {0xE58, 0x10008C0F},
194c98411dcSBitterblue Smith {0xE5C, 0x3C008C0F}, {0xE60, 0x02100000},
195c98411dcSBitterblue Smith {0xE64, 0xBBBBBBBB}, {0xE68, 0x40404040},
196c98411dcSBitterblue Smith {0xE6C, 0x80408040}, {0xE70, 0x80408040},
197c98411dcSBitterblue Smith {0xE74, 0x40404040}, {0xE78, 0x00400040},
198c98411dcSBitterblue Smith {0xE7C, 0x40404040}, {0xE80, 0x00FF0000},
199c98411dcSBitterblue Smith {0xE84, 0x80408040}, {0xE88, 0x40404040},
200c98411dcSBitterblue Smith {0xE8C, 0x80408040}, {0xED0, 0x80408040},
201c98411dcSBitterblue Smith {0xED4, 0x80408040}, {0xED8, 0x80408040},
202c98411dcSBitterblue Smith {0xEDC, 0xC040C040}, {0xEE0, 0xC040C040},
203c98411dcSBitterblue Smith {0xEE4, 0x00400040}, {0xEE8, 0xD8001402},
204c98411dcSBitterblue Smith {0xEEC, 0xC0000120}, {0xEF0, 0x02000B09},
205c98411dcSBitterblue Smith {0xEF4, 0x00000001}, {0xEF8, 0x00000000},
206c98411dcSBitterblue Smith {0xF00, 0x00000300}, {0xF04, 0x00000002},
207c98411dcSBitterblue Smith {0xF08, 0x00007D0C}, {0xF0C, 0x0000A907},
208c98411dcSBitterblue Smith {0xF10, 0x00005807}, {0xF14, 0x00000003},
209c98411dcSBitterblue Smith {0xF18, 0x07D003E8}, {0xF1C, 0x8000001F},
210c98411dcSBitterblue Smith {0xF20, 0x00000000}, {0xF24, 0x00000000},
211c98411dcSBitterblue Smith {0xF28, 0x00000000}, {0xF2C, 0x00000000},
212c98411dcSBitterblue Smith {0xF30, 0x00000000}, {0xF34, 0x00000000},
213c98411dcSBitterblue Smith {0xF38, 0x00030055}, {0xF3C, 0x0000003A},
214c98411dcSBitterblue Smith {0xF40, 0x00000002}, {0xF44, 0x00000000},
215c98411dcSBitterblue Smith {0xF48, 0x00000000}, {0xF4C, 0x0B000000},
216c98411dcSBitterblue Smith {0xF50, 0x00000000},
217c98411dcSBitterblue Smith {0xffff, 0xffffffff},
218c98411dcSBitterblue Smith };
219c98411dcSBitterblue Smith
220c98411dcSBitterblue Smith static const struct rtl8xxxu_reg32val rtl8192f_agc_table[] = {
221c98411dcSBitterblue Smith {0xC78, 0x0FA0001F}, {0xC78, 0x0FA0011F},
222c98411dcSBitterblue Smith {0xC78, 0x0FA0021F}, {0xC78, 0x0FA0031F},
223c98411dcSBitterblue Smith {0xC78, 0x0FA0041F}, {0xC78, 0x0FA0051F},
224c98411dcSBitterblue Smith {0xC78, 0x0F90061F}, {0xC78, 0x0F80071F},
225c98411dcSBitterblue Smith {0xC78, 0x0F70081F}, {0xC78, 0x0F60091F},
226c98411dcSBitterblue Smith {0xC78, 0x0F500A1F}, {0xC78, 0x0F400B1F},
227c98411dcSBitterblue Smith {0xC78, 0x0F300C1F}, {0xC78, 0x0F200D1F},
228c98411dcSBitterblue Smith {0xC78, 0x0F100E1F}, {0xC78, 0x0F000F1F},
229c98411dcSBitterblue Smith {0xC78, 0x0EF0101F}, {0xC78, 0x0EE0111F},
230c98411dcSBitterblue Smith {0xC78, 0x0ED0121F}, {0xC78, 0x0EC0131F},
231c98411dcSBitterblue Smith {0xC78, 0x0EB0141F}, {0xC78, 0x0EA0151F},
232c98411dcSBitterblue Smith {0xC78, 0x0E90161F}, {0xC78, 0x0E80171F},
233c98411dcSBitterblue Smith {0xC78, 0x0E70181F}, {0xC78, 0x0E60191F},
234c98411dcSBitterblue Smith {0xC78, 0x0E501A1F}, {0xC78, 0x0E401B1F},
235c98411dcSBitterblue Smith {0xC78, 0x0E301C1F}, {0xC78, 0x0C701D1F},
236c98411dcSBitterblue Smith {0xC78, 0x0C601E1F}, {0xC78, 0x0C501F1F},
237c98411dcSBitterblue Smith {0xC78, 0x0C40201F}, {0xC78, 0x0C30211F},
238c98411dcSBitterblue Smith {0xC78, 0x0A60221F}, {0xC78, 0x0A50231F},
239c98411dcSBitterblue Smith {0xC78, 0x0A40241F}, {0xC78, 0x0A30251F},
240c98411dcSBitterblue Smith {0xC78, 0x0860261F}, {0xC78, 0x0850271F},
241c98411dcSBitterblue Smith {0xC78, 0x0840281F}, {0xC78, 0x0830291F},
242c98411dcSBitterblue Smith {0xC78, 0x06702A1F}, {0xC78, 0x06602B1F},
243c98411dcSBitterblue Smith {0xC78, 0x06502C1F}, {0xC78, 0x06402D1F},
244c98411dcSBitterblue Smith {0xC78, 0x06302E1F}, {0xC78, 0x04602F1F},
245c98411dcSBitterblue Smith {0xC78, 0x0450301F}, {0xC78, 0x0440311F},
246c98411dcSBitterblue Smith {0xC78, 0x0430321F}, {0xC78, 0x0260331F},
247c98411dcSBitterblue Smith {0xC78, 0x0250341F}, {0xC78, 0x0240351F},
248c98411dcSBitterblue Smith {0xC78, 0x0230361F}, {0xC78, 0x0050371F},
249c98411dcSBitterblue Smith {0xC78, 0x0040381F}, {0xC78, 0x0030391F},
250c98411dcSBitterblue Smith {0xC78, 0x00203A1F}, {0xC78, 0x00103B1F},
251c98411dcSBitterblue Smith {0xC78, 0x00003C1F}, {0xC78, 0x00003D1F},
252c98411dcSBitterblue Smith {0xC78, 0x00003E1F}, {0xC78, 0x00003F1F},
253c98411dcSBitterblue Smith
254c98411dcSBitterblue Smith {0xC78, 0x0FA0401F}, {0xC78, 0x0FA0411F},
255c98411dcSBitterblue Smith {0xC78, 0x0FA0421F}, {0xC78, 0x0FA0431F},
256c98411dcSBitterblue Smith {0xC78, 0x0F90441F}, {0xC78, 0x0F80451F},
257c98411dcSBitterblue Smith {0xC78, 0x0F70461F}, {0xC78, 0x0F60471F},
258c98411dcSBitterblue Smith {0xC78, 0x0F50481F}, {0xC78, 0x0F40491F},
259c98411dcSBitterblue Smith {0xC78, 0x0F304A1F}, {0xC78, 0x0F204B1F},
260c98411dcSBitterblue Smith {0xC78, 0x0F104C1F}, {0xC78, 0x0F004D1F},
261c98411dcSBitterblue Smith {0xC78, 0x0EF04E1F}, {0xC78, 0x0EE04F1F},
262c98411dcSBitterblue Smith {0xC78, 0x0ED0501F}, {0xC78, 0x0EC0511F},
263c98411dcSBitterblue Smith {0xC78, 0x0EB0521F}, {0xC78, 0x0EA0531F},
264c98411dcSBitterblue Smith {0xC78, 0x0E90541F}, {0xC78, 0x0E80551F},
265c98411dcSBitterblue Smith {0xC78, 0x0E70561F}, {0xC78, 0x0E60571F},
266c98411dcSBitterblue Smith {0xC78, 0x0E50581F}, {0xC78, 0x0E40591F},
267c98411dcSBitterblue Smith {0xC78, 0x0E305A1F}, {0xC78, 0x0E205B1F},
268c98411dcSBitterblue Smith {0xC78, 0x0E105C1F}, {0xC78, 0x0C505D1F},
269c98411dcSBitterblue Smith {0xC78, 0x0C405E1F}, {0xC78, 0x0C305F1F},
270c98411dcSBitterblue Smith {0xC78, 0x0C20601F}, {0xC78, 0x0C10611F},
271c98411dcSBitterblue Smith {0xC78, 0x0A40621F}, {0xC78, 0x0A30631F},
272c98411dcSBitterblue Smith {0xC78, 0x0A20641F}, {0xC78, 0x0A10651F},
273c98411dcSBitterblue Smith {0xC78, 0x0840661F}, {0xC78, 0x0830671F},
274c98411dcSBitterblue Smith {0xC78, 0x0820681F}, {0xC78, 0x0810691F},
275c98411dcSBitterblue Smith {0xC78, 0x06506A1F}, {0xC78, 0x06406B1F},
276c98411dcSBitterblue Smith {0xC78, 0x06306C1F}, {0xC78, 0x06206D1F},
277c98411dcSBitterblue Smith {0xC78, 0x06106E1F}, {0xC78, 0x04406F1F},
278c98411dcSBitterblue Smith {0xC78, 0x0430701F}, {0xC78, 0x0420711F},
279c98411dcSBitterblue Smith {0xC78, 0x0410721F}, {0xC78, 0x0240731F},
280c98411dcSBitterblue Smith {0xC78, 0x0230741F}, {0xC78, 0x0220751F},
281c98411dcSBitterblue Smith {0xC78, 0x0210761F}, {0xC78, 0x0030771F},
282c98411dcSBitterblue Smith {0xC78, 0x0020781F}, {0xC78, 0x0010791F},
283c98411dcSBitterblue Smith {0xC78, 0x00007A1F}, {0xC78, 0x00007B1F},
284c98411dcSBitterblue Smith {0xC78, 0x00007C1F}, {0xC78, 0x00007D1F},
285c98411dcSBitterblue Smith {0xC78, 0x00007E1F}, {0xC78, 0x00007F1F},
286c98411dcSBitterblue Smith
287c98411dcSBitterblue Smith {0xC78, 0x0FA0801F}, {0xC78, 0x0FA0811F},
288c98411dcSBitterblue Smith {0xC78, 0x0FA0821F}, {0xC78, 0x0FA0831F},
289c98411dcSBitterblue Smith {0xC78, 0x0FA0841F}, {0xC78, 0x0FA0851F},
290c98411dcSBitterblue Smith {0xC78, 0x0F90861F}, {0xC78, 0x0F80871F},
291c98411dcSBitterblue Smith {0xC78, 0x0F70881F}, {0xC78, 0x0F60891F},
292c98411dcSBitterblue Smith {0xC78, 0x0F508A1F}, {0xC78, 0x0F408B1F},
293c98411dcSBitterblue Smith {0xC78, 0x0F308C1F}, {0xC78, 0x0F208D1F},
294c98411dcSBitterblue Smith {0xC78, 0x0F108E1F}, {0xC78, 0x0B908F1F},
295c98411dcSBitterblue Smith {0xC78, 0x0B80901F}, {0xC78, 0x0B70911F},
296c98411dcSBitterblue Smith {0xC78, 0x0B60921F}, {0xC78, 0x0B50931F},
297c98411dcSBitterblue Smith {0xC78, 0x0B40941F}, {0xC78, 0x0B30951F},
298c98411dcSBitterblue Smith {0xC78, 0x0B20961F}, {0xC78, 0x0B10971F},
299c98411dcSBitterblue Smith {0xC78, 0x0B00981F}, {0xC78, 0x0AF0991F},
300c98411dcSBitterblue Smith {0xC78, 0x0AE09A1F}, {0xC78, 0x0AD09B1F},
301c98411dcSBitterblue Smith {0xC78, 0x0AC09C1F}, {0xC78, 0x0AB09D1F},
302c98411dcSBitterblue Smith {0xC78, 0x0AA09E1F}, {0xC78, 0x0A909F1F},
303c98411dcSBitterblue Smith {0xC78, 0x0A80A01F}, {0xC78, 0x0A70A11F},
304c98411dcSBitterblue Smith {0xC78, 0x0A60A21F}, {0xC78, 0x0A50A31F},
305c98411dcSBitterblue Smith {0xC78, 0x0A40A41F}, {0xC78, 0x0A30A51F},
306c98411dcSBitterblue Smith {0xC78, 0x0A20A61F}, {0xC78, 0x0A10A71F},
307c98411dcSBitterblue Smith {0xC78, 0x0A00A81F}, {0xC78, 0x0830A91F},
308c98411dcSBitterblue Smith {0xC78, 0x0820AA1F}, {0xC78, 0x0810AB1F},
309c98411dcSBitterblue Smith {0xC78, 0x0800AC1F}, {0xC78, 0x0640AD1F},
310c98411dcSBitterblue Smith {0xC78, 0x0630AE1F}, {0xC78, 0x0620AF1F},
311c98411dcSBitterblue Smith {0xC78, 0x0610B01F}, {0xC78, 0x0600B11F},
312c98411dcSBitterblue Smith {0xC78, 0x0430B21F}, {0xC78, 0x0420B31F},
313c98411dcSBitterblue Smith {0xC78, 0x0410B41F}, {0xC78, 0x0400B51F},
314c98411dcSBitterblue Smith {0xC78, 0x0230B61F}, {0xC78, 0x0220B71F},
315c98411dcSBitterblue Smith {0xC78, 0x0210B81F}, {0xC78, 0x0200B91F},
316c98411dcSBitterblue Smith {0xC78, 0x0000BA1F}, {0xC78, 0x0000BB1F},
317c98411dcSBitterblue Smith {0xC78, 0x0000BC1F}, {0xC78, 0x0000BD1F},
318c98411dcSBitterblue Smith {0xC78, 0x0000BE1F}, {0xC78, 0x0000BF1F},
319c98411dcSBitterblue Smith {0xC50, 0x00E48024}, {0xC50, 0x00E48020},
320c98411dcSBitterblue Smith {0xffff, 0xffffffff}
321c98411dcSBitterblue Smith };
322c98411dcSBitterblue Smith
323c98411dcSBitterblue Smith static const struct rtl8xxxu_rfregval rtl8192fu_radioa_init_table[] = {
324c98411dcSBitterblue Smith {0x00, 0x30000}, {0x18, 0x0FC07}, {0x81, 0x0FC00}, {0x82, 0x003C0},
325c98411dcSBitterblue Smith {0x84, 0x00005}, {0x86, 0xA33A5}, {0x87, 0x00000}, {0x88, 0x58010},
326c98411dcSBitterblue Smith {0x8E, 0x64540}, {0x8F, 0x282D8}, {0x51, 0x02C06}, {0x52, 0x7A007},
327c98411dcSBitterblue Smith {0x53, 0x10061}, {0x54, 0x60018}, {0x55, 0x82020}, {0x56, 0x08CC6},
328c98411dcSBitterblue Smith {0x57, 0x2CC00}, {0x58, 0x00000}, {0x5A, 0x50000}, {0x5B, 0x00006},
329c98411dcSBitterblue Smith {0x5C, 0x00015}, {0x65, 0x20000}, {0x6E, 0x38319}, {0xF5, 0x43180},
330c98411dcSBitterblue Smith {0xEF, 0x00002}, {0x33, 0x00301}, {0x33, 0x1032A}, {0x33, 0x2032A},
331c98411dcSBitterblue Smith {0xEF, 0x00000}, {0xDF, 0x00002}, {0x35, 0x00000}, {0xF0, 0x08008},
332c98411dcSBitterblue Smith {0xEF, 0x00800}, {0x33, 0x0040E}, {0x33, 0x04845}, {0x33, 0x08848},
333c98411dcSBitterblue Smith {0x33, 0x0C84B}, {0x33, 0x1088A}, {0x33, 0x14C50}, {0x33, 0x18C8E},
334c98411dcSBitterblue Smith {0x33, 0x1CCCD}, {0x33, 0x20CD0}, {0x33, 0x24CD3}, {0x33, 0x28CD6},
335c98411dcSBitterblue Smith {0x33, 0x4002B}, {0x33, 0x4402E}, {0x33, 0x48846}, {0x33, 0x4C849},
336c98411dcSBitterblue Smith {0x33, 0x50888}, {0x33, 0x54CC6}, {0x33, 0x58CC9}, {0x33, 0x5CCCC},
337c98411dcSBitterblue Smith {0x33, 0x60CCF}, {0x33, 0x64CD2}, {0x33, 0x68CD5}, {0xEF, 0x00000},
338c98411dcSBitterblue Smith {0xEF, 0x00400}, {0x33, 0x01C23}, {0x33, 0x05C23}, {0x33, 0x09D23},
339c98411dcSBitterblue Smith {0x33, 0x0DD23}, {0x33, 0x11FA3}, {0x33, 0x15FA3}, {0x33, 0x19FAB},
340c98411dcSBitterblue Smith {0x33, 0x1DFAB}, {0xEF, 0x00000}, {0xEF, 0x00200}, {0x33, 0x00030},
341c98411dcSBitterblue Smith {0x33, 0x04030}, {0x33, 0x08030}, {0x33, 0x0C030}, {0x33, 0x10030},
342c98411dcSBitterblue Smith {0x33, 0x14030}, {0x33, 0x18030}, {0x33, 0x1C030}, {0x33, 0x20030},
343c98411dcSBitterblue Smith {0x33, 0x24030}, {0x33, 0x28030}, {0x33, 0x2C030}, {0x33, 0x30030},
344c98411dcSBitterblue Smith {0x33, 0x34030}, {0x33, 0x38030}, {0x33, 0x3C030}, {0xEF, 0x00000},
345c98411dcSBitterblue Smith {0xEF, 0x00100}, {0x33, 0x44001}, {0x33, 0x48001}, {0x33, 0x4C001},
346c98411dcSBitterblue Smith {0x33, 0x50001}, {0x33, 0x54001}, {0x33, 0x58001}, {0x33, 0x5C001},
347c98411dcSBitterblue Smith {0x33, 0x60001}, {0x33, 0x64001}, {0x33, 0x68001}, {0x33, 0x6C001},
348c98411dcSBitterblue Smith {0x33, 0x70001}, {0x33, 0x74001}, {0x33, 0x78001}, {0x33, 0x04000},
349c98411dcSBitterblue Smith {0x33, 0x08000}, {0x33, 0x0C000}, {0x33, 0x10000}, {0x33, 0x14000},
350c98411dcSBitterblue Smith {0x33, 0x18001}, {0x33, 0x1C002}, {0x33, 0x20002}, {0x33, 0x24002},
351c98411dcSBitterblue Smith {0x33, 0x28002}, {0x33, 0x2C002}, {0x33, 0x30002}, {0x33, 0x34002},
352c98411dcSBitterblue Smith {0x33, 0x38002}, {0xEF, 0x00000}, {0x84, 0x00000}, {0xEF, 0x80010},
353c98411dcSBitterblue Smith {0x30, 0x20000}, {0x31, 0x0006F}, {0x32, 0x01FF7}, {0xEF, 0x00000},
354c98411dcSBitterblue Smith {0x84, 0x00000}, {0xEF, 0x80000}, {0x30, 0x30000}, {0x31, 0x0006F},
355c98411dcSBitterblue Smith {0x32, 0xF1DF3}, {0xEF, 0x00000}, {0x84, 0x00000}, {0xEF, 0x80000},
356c98411dcSBitterblue Smith {0x30, 0x38000}, {0x31, 0x0006F}, {0x32, 0xF1FF2}, {0xEF, 0x00000},
357c98411dcSBitterblue Smith {0x1B, 0x746CE}, {0xEF, 0x20000}, {0x33, 0x30000}, {0x33, 0x38000},
358c98411dcSBitterblue Smith {0x33, 0x70000}, {0x33, 0x78000}, {0xEF, 0x00000}, {0xDF, 0x08000},
359c98411dcSBitterblue Smith {0xB0, 0xFFBCB}, {0xB3, 0x06000}, {0xB7, 0x18DF0}, {0xB8, 0x38FF0},
360c98411dcSBitterblue Smith {0xC9, 0x00600}, {0xDF, 0x00000}, {0xB1, 0x33B8F}, {0xB2, 0x33762},
361c98411dcSBitterblue Smith {0xB4, 0x141F0}, {0xB5, 0x14080}, {0xB6, 0x12425}, {0xB9, 0xC0008},
362c98411dcSBitterblue Smith {0xBA, 0x40005}, {0xC2, 0x02C01}, {0xC3, 0x0000B}, {0xC4, 0x81E2F},
363c98411dcSBitterblue Smith {0xC5, 0x5C28F}, {0xC6, 0x000A0}, {0xCA, 0x02000}, {0xFE, 0x00000},
364c98411dcSBitterblue Smith {0x18, 0x08C07}, {0xFE, 0x00000}, {0xFE, 0x00000}, {0xFE, 0x00000},
365c98411dcSBitterblue Smith {0x00, 0x31DD5},
366c98411dcSBitterblue Smith {0xff, 0xffffffff}
367c98411dcSBitterblue Smith };
368c98411dcSBitterblue Smith
369c98411dcSBitterblue Smith static const struct rtl8xxxu_rfregval rtl8192fu_radiob_init_table[] = {
370c98411dcSBitterblue Smith {0x00, 0x30000}, {0x81, 0x0FC00}, {0x82, 0x003C0}, {0x84, 0x00005},
371c98411dcSBitterblue Smith {0x86, 0xA33A5}, {0x87, 0x00000}, {0x88, 0x58010}, {0x8E, 0x64540},
372c98411dcSBitterblue Smith {0x8F, 0x282D8}, {0x51, 0x02C06}, {0x52, 0x7A007}, {0x53, 0x10061},
373c98411dcSBitterblue Smith {0x54, 0x60018}, {0x55, 0x82020}, {0x56, 0x08CC6}, {0x57, 0x2CC00},
374c98411dcSBitterblue Smith {0x58, 0x00000}, {0x5A, 0x50000}, {0x5B, 0x00006}, {0x5C, 0x00015},
375c98411dcSBitterblue Smith {0x65, 0x20000}, {0x6E, 0x38319}, {0xF5, 0x43180}, {0xEF, 0x00002},
376c98411dcSBitterblue Smith {0x33, 0x00301}, {0x33, 0x1032A}, {0x33, 0x2032A}, {0xEF, 0x00000},
377c98411dcSBitterblue Smith {0xDF, 0x00002}, {0x35, 0x00000}, {0xF0, 0x08008}, {0xEF, 0x00800},
378c98411dcSBitterblue Smith {0x33, 0x0040E}, {0x33, 0x04845}, {0x33, 0x08848}, {0x33, 0x0C84B},
379c98411dcSBitterblue Smith {0x33, 0x1088A}, {0x33, 0x14CC8}, {0x33, 0x18CCB}, {0x33, 0x1CCCE},
380c98411dcSBitterblue Smith {0x33, 0x20CD1}, {0x33, 0x24CD4}, {0x33, 0x28CD7}, {0x33, 0x4002B},
381c98411dcSBitterblue Smith {0x33, 0x4402E}, {0x33, 0x48846}, {0x33, 0x4C849}, {0x33, 0x50888},
382c98411dcSBitterblue Smith {0x33, 0x54CC6}, {0x33, 0x58CC9}, {0x33, 0x5CCCC}, {0x33, 0x60CCF},
383c98411dcSBitterblue Smith {0x33, 0x64CD2}, {0x33, 0x68CD5}, {0xEF, 0x00000}, {0xEF, 0x00400},
384c98411dcSBitterblue Smith {0x33, 0x01D23}, {0x33, 0x05D23}, {0x33, 0x09FA3}, {0x33, 0x0DFA3},
385c98411dcSBitterblue Smith {0x33, 0x11D2B}, {0x33, 0x15D2B}, {0x33, 0x19FAB}, {0x33, 0x1DFAB},
386c98411dcSBitterblue Smith {0xEF, 0x00000}, {0xEF, 0x00200}, {0x33, 0x00030}, {0x33, 0x04030},
387c98411dcSBitterblue Smith {0x33, 0x08030}, {0x33, 0x0C030}, {0x33, 0x10030}, {0x33, 0x14030},
388c98411dcSBitterblue Smith {0x33, 0x18030}, {0x33, 0x1C030}, {0x33, 0x20030}, {0x33, 0x24030},
389c98411dcSBitterblue Smith {0x33, 0x28030}, {0x33, 0x2C030}, {0x33, 0x30030}, {0x33, 0x34030},
390c98411dcSBitterblue Smith {0x33, 0x38030}, {0x33, 0x3C030}, {0xEF, 0x00000}, {0xEF, 0x00100},
391c98411dcSBitterblue Smith {0x33, 0x44000}, {0x33, 0x48000}, {0x33, 0x4C000}, {0x33, 0x50000},
392c98411dcSBitterblue Smith {0x33, 0x54000}, {0x33, 0x58000}, {0x33, 0x5C000}, {0x33, 0x60000},
393c98411dcSBitterblue Smith {0x33, 0x64000}, {0x33, 0x68000}, {0x33, 0x6C000}, {0x33, 0x70000},
394c98411dcSBitterblue Smith {0x33, 0x74000}, {0x33, 0x78000}, {0x33, 0x04000}, {0x33, 0x08000},
395c98411dcSBitterblue Smith {0x33, 0x0C000}, {0x33, 0x10000}, {0x33, 0x14000}, {0x33, 0x18000},
396c98411dcSBitterblue Smith {0x33, 0x1C001}, {0x33, 0x20001}, {0x33, 0x24001}, {0x33, 0x28001},
397c98411dcSBitterblue Smith {0x33, 0x2C001}, {0x33, 0x30001}, {0x33, 0x34001}, {0x33, 0x38001},
398c98411dcSBitterblue Smith {0xEF, 0x00000}, {0x84, 0x00000}, {0xEF, 0x80010}, {0x30, 0x20000},
399c98411dcSBitterblue Smith {0x31, 0x0006F}, {0x32, 0x01FF7}, {0xEF, 0x00000}, {0x84, 0x00000},
400c98411dcSBitterblue Smith {0xEF, 0x80000}, {0x30, 0x30000}, {0x31, 0x0006F}, {0x32, 0xF1DF3},
401c98411dcSBitterblue Smith {0xEF, 0x00000}, {0x84, 0x00000}, {0xEF, 0x80000}, {0x30, 0x38000},
402c98411dcSBitterblue Smith {0x31, 0x0006F}, {0x32, 0xF1FF2}, {0xEF, 0x00000}, {0x1B, 0x746CE},
403c98411dcSBitterblue Smith {0xEF, 0x20000}, {0x33, 0x30000}, {0x33, 0x38000}, {0x33, 0x70000},
404c98411dcSBitterblue Smith {0x33, 0x78000}, {0xEF, 0x00000}, {0x00, 0x31DD5},
405c98411dcSBitterblue Smith {0xff, 0xffffffff}
406c98411dcSBitterblue Smith };
407c98411dcSBitterblue Smith
rtl8192fu_identify_chip(struct rtl8xxxu_priv * priv)408c98411dcSBitterblue Smith static int rtl8192fu_identify_chip(struct rtl8xxxu_priv *priv)
409c98411dcSBitterblue Smith {
410c98411dcSBitterblue Smith struct device *dev = &priv->udev->dev;
411c98411dcSBitterblue Smith u32 sys_cfg, vendor, val32;
412c98411dcSBitterblue Smith
413c98411dcSBitterblue Smith strscpy(priv->chip_name, "8192FU", sizeof(priv->chip_name));
414c98411dcSBitterblue Smith priv->rtl_chip = RTL8192F;
415c98411dcSBitterblue Smith priv->rf_paths = 2;
416c98411dcSBitterblue Smith priv->rx_paths = 2;
417c98411dcSBitterblue Smith priv->tx_paths = 2;
418c98411dcSBitterblue Smith
419c98411dcSBitterblue Smith sys_cfg = rtl8xxxu_read32(priv, REG_SYS_CFG);
420c98411dcSBitterblue Smith priv->chip_cut = u32_get_bits(sys_cfg, SYS_CFG_CHIP_VERSION_MASK);
421c98411dcSBitterblue Smith if (sys_cfg & SYS_CFG_TRP_VAUX_EN) {
422c98411dcSBitterblue Smith dev_info(dev, "Unsupported test chip\n");
423c98411dcSBitterblue Smith return -EOPNOTSUPP;
424c98411dcSBitterblue Smith }
425c98411dcSBitterblue Smith
426c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_MULTI_FUNC_CTRL);
427c98411dcSBitterblue Smith priv->has_wifi = u32_get_bits(val32, MULTI_WIFI_FUNC_EN);
428c98411dcSBitterblue Smith priv->has_bluetooth = u32_get_bits(val32, MULTI_BT_FUNC_EN);
429c98411dcSBitterblue Smith priv->has_gps = u32_get_bits(val32, MULTI_GPS_FUNC_EN);
430c98411dcSBitterblue Smith priv->is_multi_func = 1;
431c98411dcSBitterblue Smith
432c98411dcSBitterblue Smith vendor = sys_cfg & SYS_CFG_VENDOR_ID;
433c98411dcSBitterblue Smith rtl8xxxu_identify_vendor_1bit(priv, vendor);
434c98411dcSBitterblue Smith
435c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_GPIO_OUTSTS);
436c98411dcSBitterblue Smith priv->rom_rev = u32_get_bits(val32, GPIO_RF_RL_ID);
437c98411dcSBitterblue Smith
438c98411dcSBitterblue Smith return rtl8xxxu_config_endpoints_no_sie(priv);
439c98411dcSBitterblue Smith }
440c98411dcSBitterblue Smith
441c98411dcSBitterblue Smith static void
rtl8192f_set_tx_power(struct rtl8xxxu_priv * priv,int channel,bool ht40)442c98411dcSBitterblue Smith rtl8192f_set_tx_power(struct rtl8xxxu_priv *priv, int channel, bool ht40)
443c98411dcSBitterblue Smith {
444c98411dcSBitterblue Smith u8 cck, ofdmbase, mcsbase;
445c98411dcSBitterblue Smith u32 val32, ofdm, mcs;
446c98411dcSBitterblue Smith int group, cck_group;
447c98411dcSBitterblue Smith
448c98411dcSBitterblue Smith rtl8188f_channel_to_group(channel, &group, &cck_group);
449c98411dcSBitterblue Smith
450c98411dcSBitterblue Smith cck = priv->cck_tx_power_index_A[cck_group];
451c98411dcSBitterblue Smith
452c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_A_CCK1_MCS32, 0x00007f00, cck);
453c98411dcSBitterblue Smith
454c98411dcSBitterblue Smith val32 = (cck << 16) | (cck << 8) | cck;
455c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_B_CCK11_A_CCK2_11,
456c98411dcSBitterblue Smith 0x7f7f7f00, val32);
457c98411dcSBitterblue Smith
458c98411dcSBitterblue Smith ofdmbase = priv->ht40_1s_tx_power_index_A[group];
459c98411dcSBitterblue Smith ofdmbase += priv->ofdm_tx_power_diff[RF_A].a;
460c98411dcSBitterblue Smith ofdm = ofdmbase | ofdmbase << 8 | ofdmbase << 16 | ofdmbase << 24;
461c98411dcSBitterblue Smith
462c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_A_RATE18_06, 0x7f7f7f7f, ofdm);
463c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_A_RATE54_24, 0x7f7f7f7f, ofdm);
464c98411dcSBitterblue Smith
465c98411dcSBitterblue Smith mcsbase = priv->ht40_1s_tx_power_index_A[group];
466c98411dcSBitterblue Smith if (ht40)
467c98411dcSBitterblue Smith mcsbase += priv->ht40_tx_power_diff[RF_A].a;
468c98411dcSBitterblue Smith else
469c98411dcSBitterblue Smith mcsbase += priv->ht20_tx_power_diff[RF_A].a;
470c98411dcSBitterblue Smith mcs = mcsbase | mcsbase << 8 | mcsbase << 16 | mcsbase << 24;
471c98411dcSBitterblue Smith
472c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_A_MCS03_MCS00, 0x7f7f7f7f, mcs);
473c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_A_MCS07_MCS04, 0x7f7f7f7f, mcs);
474c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_A_MCS11_MCS08, 0x7f7f7f7f, mcs);
475c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_A_MCS15_MCS12, 0x7f7f7f7f, mcs);
476c98411dcSBitterblue Smith
477c98411dcSBitterblue Smith if (priv->tx_paths == 1)
478c98411dcSBitterblue Smith return;
479c98411dcSBitterblue Smith
480c98411dcSBitterblue Smith cck = priv->cck_tx_power_index_B[cck_group];
481c98411dcSBitterblue Smith
482c98411dcSBitterblue Smith val32 = (cck << 16) | (cck << 8) | cck;
483c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_B_CCK1_55_MCS32,
484c98411dcSBitterblue Smith 0x7f7f7f00, val32);
485c98411dcSBitterblue Smith
486c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_B_CCK11_A_CCK2_11,
487c98411dcSBitterblue Smith 0x0000007f, cck);
488c98411dcSBitterblue Smith
489c98411dcSBitterblue Smith ofdmbase = priv->ht40_1s_tx_power_index_B[group];
490c98411dcSBitterblue Smith ofdmbase += priv->ofdm_tx_power_diff[RF_B].b;
491c98411dcSBitterblue Smith ofdm = ofdmbase | ofdmbase << 8 | ofdmbase << 16 | ofdmbase << 24;
492c98411dcSBitterblue Smith
493c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_B_RATE18_06, 0x7f7f7f7f, ofdm);
494c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_B_RATE54_24, 0x7f7f7f7f, ofdm);
495c98411dcSBitterblue Smith
496c98411dcSBitterblue Smith mcsbase = priv->ht40_1s_tx_power_index_B[group];
497c98411dcSBitterblue Smith if (ht40)
498c98411dcSBitterblue Smith mcsbase += priv->ht40_tx_power_diff[RF_B].b;
499c98411dcSBitterblue Smith else
500c98411dcSBitterblue Smith mcsbase += priv->ht20_tx_power_diff[RF_B].b;
501c98411dcSBitterblue Smith mcs = mcsbase | mcsbase << 8 | mcsbase << 16 | mcsbase << 24;
502c98411dcSBitterblue Smith
503c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_B_MCS03_MCS00, 0x7f7f7f7f, mcs);
504c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_B_MCS07_MCS04, 0x7f7f7f7f, mcs);
505c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_B_MCS11_MCS08, 0x7f7f7f7f, mcs);
506c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_AGC_B_MCS15_MCS12, 0x7f7f7f7f, mcs);
507c98411dcSBitterblue Smith }
508c98411dcSBitterblue Smith
rtl8192f_revise_cck_tx_psf(struct rtl8xxxu_priv * priv,u8 channel)509c98411dcSBitterblue Smith static void rtl8192f_revise_cck_tx_psf(struct rtl8xxxu_priv *priv, u8 channel)
510c98411dcSBitterblue Smith {
511c98411dcSBitterblue Smith if (channel == 13) {
512c98411dcSBitterblue Smith /* Special value for channel 13 */
513c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_CCK0_TX_FILTER1, 0xf8fe0001);
514c98411dcSBitterblue Smith /* Normal values */
515c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_CCK0_TX_FILTER2, 0x64B80C1C);
516c98411dcSBitterblue Smith rtl8xxxu_write16(priv, REG_CCK0_DEBUG_PORT, 0x8810);
517c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_CCK0_TX_FILTER3, 0x01235667);
518c98411dcSBitterblue Smith } else if (channel == 14) {
519c98411dcSBitterblue Smith /* Normal value */
520c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_CCK0_TX_FILTER1, 0xE82C0001);
521c98411dcSBitterblue Smith /* Special values for channel 14 */
522c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_CCK0_TX_FILTER2, 0x0000B81C);
523c98411dcSBitterblue Smith rtl8xxxu_write16(priv, REG_CCK0_DEBUG_PORT, 0x0000);
524c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_CCK0_TX_FILTER3, 0x00003667);
525c98411dcSBitterblue Smith } else {
526c98411dcSBitterblue Smith /* Restore normal values from the phy init table */
527c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_CCK0_TX_FILTER1, 0xE82C0001);
528c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_CCK0_TX_FILTER2, 0x64B80C1C);
529c98411dcSBitterblue Smith rtl8xxxu_write16(priv, REG_CCK0_DEBUG_PORT, 0x8810);
530c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_CCK0_TX_FILTER3, 0x01235667);
531c98411dcSBitterblue Smith }
532c98411dcSBitterblue Smith }
533c98411dcSBitterblue Smith
rtl8192fu_config_kfree(struct rtl8xxxu_priv * priv,u8 channel)534c98411dcSBitterblue Smith static void rtl8192fu_config_kfree(struct rtl8xxxu_priv *priv, u8 channel)
535c98411dcSBitterblue Smith {
536c98411dcSBitterblue Smith u8 bb_gain[3] = { EFUSE_UNDEFINED, EFUSE_UNDEFINED, EFUSE_UNDEFINED };
537c98411dcSBitterblue Smith u8 bb_gain_path_mask[2] = { 0x0f, 0xf0 };
538c98411dcSBitterblue Smith enum rtl8xxxu_rfpath rfpath;
539c98411dcSBitterblue Smith u8 bb_gain_for_path;
540c98411dcSBitterblue Smith u8 channel_idx = 0;
541c98411dcSBitterblue Smith
542c98411dcSBitterblue Smith if (channel >= 1 && channel <= 3)
543c98411dcSBitterblue Smith channel_idx = 0;
544c98411dcSBitterblue Smith if (channel >= 4 && channel <= 9)
545c98411dcSBitterblue Smith channel_idx = 1;
546c98411dcSBitterblue Smith if (channel >= 10 && channel <= 14)
547c98411dcSBitterblue Smith channel_idx = 2;
548c98411dcSBitterblue Smith
549c98411dcSBitterblue Smith rtl8xxxu_read_efuse8(priv, 0x1ee, &bb_gain[1]);
550c98411dcSBitterblue Smith rtl8xxxu_read_efuse8(priv, 0x1ec, &bb_gain[0]);
551c98411dcSBitterblue Smith rtl8xxxu_read_efuse8(priv, 0x1ea, &bb_gain[2]);
552c98411dcSBitterblue Smith
553c98411dcSBitterblue Smith if (bb_gain[1] == EFUSE_UNDEFINED)
554c98411dcSBitterblue Smith return;
555c98411dcSBitterblue Smith
556c98411dcSBitterblue Smith if (bb_gain[0] == EFUSE_UNDEFINED)
557c98411dcSBitterblue Smith bb_gain[0] = bb_gain[1];
558c98411dcSBitterblue Smith
559c98411dcSBitterblue Smith if (bb_gain[2] == EFUSE_UNDEFINED)
560c98411dcSBitterblue Smith bb_gain[2] = bb_gain[1];
561c98411dcSBitterblue Smith
562c98411dcSBitterblue Smith for (rfpath = RF_A; rfpath < priv->rf_paths; rfpath++) {
563c98411dcSBitterblue Smith /* power_trim based on 55[19:14] */
564c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, rfpath, RF6052_REG_UNKNOWN_55,
565c98411dcSBitterblue Smith BIT(5), 1);
566c98411dcSBitterblue Smith
567c98411dcSBitterblue Smith /* enable 55[14] for 0.5db step */
568c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, rfpath, RF6052_REG_GAIN_CTRL,
569c98411dcSBitterblue Smith BIT(18), 1);
570c98411dcSBitterblue Smith
571c98411dcSBitterblue Smith /* enter power_trim debug mode */
572103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, rfpath, RF6052_REG_GAIN_CCA,
573c98411dcSBitterblue Smith BIT(7), 1);
574c98411dcSBitterblue Smith
575c98411dcSBitterblue Smith /* write enable */
576c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, rfpath, RF6052_REG_WE_LUT, BIT(7), 1);
577c98411dcSBitterblue Smith
578c98411dcSBitterblue Smith bb_gain_for_path = (bb_gain[channel_idx] & bb_gain_path_mask[rfpath]);
579c98411dcSBitterblue Smith bb_gain_for_path >>= __ffs(bb_gain_path_mask[rfpath]);
580c98411dcSBitterblue Smith
581c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, rfpath, RF6052_REG_TXPA_G3,
582c98411dcSBitterblue Smith 0x70000, channel_idx * 2);
583c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, rfpath, RF6052_REG_TXPA_G3,
584c98411dcSBitterblue Smith 0x3f, bb_gain_for_path);
585c98411dcSBitterblue Smith
586c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, rfpath, RF6052_REG_TXPA_G3,
587c98411dcSBitterblue Smith 0x70000, channel_idx * 2 + 1);
588c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, rfpath, RF6052_REG_TXPA_G3,
589c98411dcSBitterblue Smith 0x3f, bb_gain_for_path);
590c98411dcSBitterblue Smith
591c98411dcSBitterblue Smith /* leave power_trim debug mode */
592103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, rfpath, RF6052_REG_GAIN_CCA,
593c98411dcSBitterblue Smith BIT(7), 0);
594c98411dcSBitterblue Smith
595c98411dcSBitterblue Smith /* write disable */
596c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, rfpath, RF6052_REG_WE_LUT, BIT(7), 0);
597c98411dcSBitterblue Smith }
598c98411dcSBitterblue Smith }
599c98411dcSBitterblue Smith
rtl8192fu_config_channel(struct ieee80211_hw * hw)600c98411dcSBitterblue Smith static void rtl8192fu_config_channel(struct ieee80211_hw *hw)
601c98411dcSBitterblue Smith {
602c98411dcSBitterblue Smith struct rtl8xxxu_priv *priv = hw->priv;
603c98411dcSBitterblue Smith bool ht40 = conf_is_ht40(&hw->conf);
604c98411dcSBitterblue Smith u8 channel, subchannel = 0;
605c98411dcSBitterblue Smith bool sec_ch_above = 0;
606c98411dcSBitterblue Smith u32 val32;
607c98411dcSBitterblue Smith
608c98411dcSBitterblue Smith channel = (u8)hw->conf.chandef.chan->hw_value;
609c98411dcSBitterblue Smith
610c98411dcSBitterblue Smith if (conf_is_ht40_plus(&hw->conf)) {
611c98411dcSBitterblue Smith sec_ch_above = 1;
612c98411dcSBitterblue Smith channel += 2;
613c98411dcSBitterblue Smith subchannel = 2;
614c98411dcSBitterblue Smith } else if (conf_is_ht40_minus(&hw->conf)) {
615c98411dcSBitterblue Smith sec_ch_above = 0;
616c98411dcSBitterblue Smith channel -= 2;
617c98411dcSBitterblue Smith subchannel = 1;
618c98411dcSBitterblue Smith }
619c98411dcSBitterblue Smith
620c98411dcSBitterblue Smith val32 = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_MODE_AG);
621c98411dcSBitterblue Smith
622c98411dcSBitterblue Smith rtl8192f_revise_cck_tx_psf(priv, channel);
623c98411dcSBitterblue Smith
624c98411dcSBitterblue Smith /* Set channel */
625c98411dcSBitterblue Smith val32 &= ~(BIT(18) | BIT(17)); /* select the 2.4G band(?) */
626c98411dcSBitterblue Smith u32p_replace_bits(&val32, channel, 0xff);
627c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_MODE_AG, val32);
628c98411dcSBitterblue Smith if (priv->rf_paths > 1)
629c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_MODE_AG, val32);
630c98411dcSBitterblue Smith
631c98411dcSBitterblue Smith rtl8192fu_config_kfree(priv, channel);
632c98411dcSBitterblue Smith
633c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_DATA_SUBCHANNEL, subchannel);
634c98411dcSBitterblue Smith
635c98411dcSBitterblue Smith /* small BW */
636c98411dcSBitterblue Smith rtl8xxxu_write32_clear(priv, REG_OFDM0_TX_PSDO_NOISE_WEIGHT, GENMASK(31, 30));
637c98411dcSBitterblue Smith
638c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_RF_MODE, FPGA_RF_MODE, ht40);
639c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA1_RF_MODE, FPGA_RF_MODE, ht40);
640c98411dcSBitterblue Smith
641c98411dcSBitterblue Smith /* ADC clock = 160M */
642c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_RF_MODE, GENMASK(10, 8), 4);
643c98411dcSBitterblue Smith
644c98411dcSBitterblue Smith /* DAC clock = 80M */
645c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_RF_MODE, BIT(13) | BIT(12), 2);
646c98411dcSBitterblue Smith
647c98411dcSBitterblue Smith /* ADC buffer clk */
648c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_ANTDIV_PARA1, BIT(27) | BIT(26), 2);
649c98411dcSBitterblue Smith
650c98411dcSBitterblue Smith if (ht40)
651c98411dcSBitterblue Smith /* Set Control channel to upper or lower. */
652c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_CCK0_SYSTEM,
653c98411dcSBitterblue Smith CCK0_SIDEBAND, !sec_ch_above);
654c98411dcSBitterblue Smith
655c98411dcSBitterblue Smith /* Enable CCK */
656c98411dcSBitterblue Smith rtl8xxxu_write32_set(priv, REG_FPGA0_RF_MODE, FPGA_RF_MODE_CCK);
657c98411dcSBitterblue Smith
658c98411dcSBitterblue Smith /* RF TRX_BW */
659c98411dcSBitterblue Smith val32 = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_MODE_AG);
660c98411dcSBitterblue Smith val32 &= ~MODE_AG_BW_MASK;
661c98411dcSBitterblue Smith if (ht40)
662c98411dcSBitterblue Smith val32 |= MODE_AG_BW_40MHZ_8723B;
663c98411dcSBitterblue Smith else
664c98411dcSBitterblue Smith val32 |= MODE_AG_BW_20MHZ_8723B;
665c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_MODE_AG, val32);
666c98411dcSBitterblue Smith if (priv->rf_paths > 1)
667c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_MODE_AG, val32);
668c98411dcSBitterblue Smith
669c98411dcSBitterblue Smith /* Modify RX DFIR parameters */
670c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TAP_UPD_97F, BIT(21) | BIT(20), 2);
671c98411dcSBitterblue Smith
672c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_DOWNSAM_FACTOR, BIT(29) | BIT(28), 2);
673c98411dcSBitterblue Smith
674c98411dcSBitterblue Smith if (ht40)
675c98411dcSBitterblue Smith val32 = 0x3;
676c98411dcSBitterblue Smith else
677c98411dcSBitterblue Smith val32 = 0x1a3;
678c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RX_DFIR_MOD_97F, 0x1ff, val32);
679c98411dcSBitterblue Smith }
680c98411dcSBitterblue Smith
rtl8192fu_init_aggregation(struct rtl8xxxu_priv * priv)681c98411dcSBitterblue Smith static void rtl8192fu_init_aggregation(struct rtl8xxxu_priv *priv)
682c98411dcSBitterblue Smith {
683c98411dcSBitterblue Smith u32 agg_rx;
684c98411dcSBitterblue Smith u8 agg_ctrl;
685c98411dcSBitterblue Smith
686c98411dcSBitterblue Smith /* RX aggregation */
687c98411dcSBitterblue Smith agg_ctrl = rtl8xxxu_read8(priv, REG_TRXDMA_CTRL);
688c98411dcSBitterblue Smith agg_ctrl &= ~TRXDMA_CTRL_RXDMA_AGG_EN;
689c98411dcSBitterblue Smith
690c98411dcSBitterblue Smith agg_rx = rtl8xxxu_read32(priv, REG_RXDMA_AGG_PG_TH);
691c98411dcSBitterblue Smith agg_rx &= ~RXDMA_USB_AGG_ENABLE;
692c98411dcSBitterblue Smith agg_rx &= ~0xFF0F; /* reset agg size and timeout */
693c98411dcSBitterblue Smith
694c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_TRXDMA_CTRL, agg_ctrl);
695c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RXDMA_AGG_PG_TH, agg_rx);
696c98411dcSBitterblue Smith }
697c98411dcSBitterblue Smith
rtl8192fu_parse_efuse(struct rtl8xxxu_priv * priv)698c98411dcSBitterblue Smith static int rtl8192fu_parse_efuse(struct rtl8xxxu_priv *priv)
699c98411dcSBitterblue Smith {
700c98411dcSBitterblue Smith struct rtl8192fu_efuse *efuse = &priv->efuse_wifi.efuse8192fu;
701c98411dcSBitterblue Smith int i;
702c98411dcSBitterblue Smith
703c98411dcSBitterblue Smith if (efuse->rtl_id != cpu_to_le16(0x8129))
704c98411dcSBitterblue Smith return -EINVAL;
705c98411dcSBitterblue Smith
706c98411dcSBitterblue Smith ether_addr_copy(priv->mac_addr, efuse->mac_addr);
707c98411dcSBitterblue Smith
708c98411dcSBitterblue Smith memcpy(priv->cck_tx_power_index_A, efuse->tx_power_index_A.cck_base,
709c98411dcSBitterblue Smith sizeof(efuse->tx_power_index_A.cck_base));
710c98411dcSBitterblue Smith memcpy(priv->cck_tx_power_index_B, efuse->tx_power_index_B.cck_base,
711c98411dcSBitterblue Smith sizeof(efuse->tx_power_index_B.cck_base));
712c98411dcSBitterblue Smith
713c98411dcSBitterblue Smith memcpy(priv->ht40_1s_tx_power_index_A,
714c98411dcSBitterblue Smith efuse->tx_power_index_A.ht40_base,
715c98411dcSBitterblue Smith sizeof(efuse->tx_power_index_A.ht40_base));
716c98411dcSBitterblue Smith memcpy(priv->ht40_1s_tx_power_index_B,
717c98411dcSBitterblue Smith efuse->tx_power_index_B.ht40_base,
718c98411dcSBitterblue Smith sizeof(efuse->tx_power_index_B.ht40_base));
719c98411dcSBitterblue Smith
720c98411dcSBitterblue Smith priv->ht20_tx_power_diff[0].a =
721c98411dcSBitterblue Smith efuse->tx_power_index_A.ht20_ofdm_1s_diff.b;
722c98411dcSBitterblue Smith priv->ht20_tx_power_diff[0].b =
723c98411dcSBitterblue Smith efuse->tx_power_index_B.ht20_ofdm_1s_diff.b;
724c98411dcSBitterblue Smith
725c98411dcSBitterblue Smith priv->ht40_tx_power_diff[0].a = 0;
726c98411dcSBitterblue Smith priv->ht40_tx_power_diff[0].b = 0;
727c98411dcSBitterblue Smith
728c98411dcSBitterblue Smith for (i = 1; i < RTL8723B_TX_COUNT; i++) {
729c98411dcSBitterblue Smith priv->ofdm_tx_power_diff[i].a =
730c98411dcSBitterblue Smith efuse->tx_power_index_A.pwr_diff[i - 1].ofdm;
731c98411dcSBitterblue Smith priv->ofdm_tx_power_diff[i].b =
732c98411dcSBitterblue Smith efuse->tx_power_index_B.pwr_diff[i - 1].ofdm;
733c98411dcSBitterblue Smith
734c98411dcSBitterblue Smith priv->ht20_tx_power_diff[i].a =
735c98411dcSBitterblue Smith efuse->tx_power_index_A.pwr_diff[i - 1].ht20;
736c98411dcSBitterblue Smith priv->ht20_tx_power_diff[i].b =
737c98411dcSBitterblue Smith efuse->tx_power_index_B.pwr_diff[i - 1].ht20;
738c98411dcSBitterblue Smith
739c98411dcSBitterblue Smith priv->ht40_tx_power_diff[i].a =
740c98411dcSBitterblue Smith efuse->tx_power_index_A.pwr_diff[i - 1].ht40;
741c98411dcSBitterblue Smith priv->ht40_tx_power_diff[i].b =
742c98411dcSBitterblue Smith efuse->tx_power_index_B.pwr_diff[i - 1].ht40;
743c98411dcSBitterblue Smith }
744c98411dcSBitterblue Smith
745c98411dcSBitterblue Smith priv->default_crystal_cap = efuse->xtal_k & 0x3f;
746c98411dcSBitterblue Smith
747c98411dcSBitterblue Smith priv->rfe_type = efuse->rfe_option & 0x1f;
748c98411dcSBitterblue Smith
749c98411dcSBitterblue Smith if (priv->rfe_type != 5 && priv->rfe_type != 1)
750c98411dcSBitterblue Smith dev_warn(&priv->udev->dev,
751c98411dcSBitterblue Smith "%s: RFE type %d was not tested. Please send an email to linux-wireless@vger.kernel.org about this.\n",
752c98411dcSBitterblue Smith __func__, priv->rfe_type);
753c98411dcSBitterblue Smith
754c98411dcSBitterblue Smith return 0;
755c98411dcSBitterblue Smith }
756c98411dcSBitterblue Smith
rtl8192fu_load_firmware(struct rtl8xxxu_priv * priv)757c98411dcSBitterblue Smith static int rtl8192fu_load_firmware(struct rtl8xxxu_priv *priv)
758c98411dcSBitterblue Smith {
759c98411dcSBitterblue Smith return rtl8xxxu_load_firmware(priv, "rtlwifi/rtl8192fufw.bin");
760c98411dcSBitterblue Smith }
761c98411dcSBitterblue Smith
rtl8192fu_init_phy_bb(struct rtl8xxxu_priv * priv)762c98411dcSBitterblue Smith static void rtl8192fu_init_phy_bb(struct rtl8xxxu_priv *priv)
763c98411dcSBitterblue Smith {
764c98411dcSBitterblue Smith /* Enable BB and RF */
765c98411dcSBitterblue Smith rtl8xxxu_write16_set(priv, REG_SYS_FUNC,
766c98411dcSBitterblue Smith SYS_FUNC_BBRSTB | SYS_FUNC_BB_GLB_RSTN);
767c98411dcSBitterblue Smith
768c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_RF_CTRL, RF_ENABLE | RF_RSTB | RF_SDMRSTB);
769c98411dcSBitterblue Smith
770c98411dcSBitterblue Smith /* To Fix MAC loopback mode fail. */
771c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_LDOHCI12_CTRL, 0xf);
772c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_SYS_SWR_CTRL2 + 1, 0xe9);
773c98411dcSBitterblue Smith
774c98411dcSBitterblue Smith rtl8xxxu_init_phy_regs(priv, rtl8192fu_phy_init_table);
775c98411dcSBitterblue Smith
776c98411dcSBitterblue Smith rtl8xxxu_init_phy_regs(priv, rtl8192f_agc_table);
777c98411dcSBitterblue Smith }
778c98411dcSBitterblue Smith
rtl8192fu_init_phy_rf(struct rtl8xxxu_priv * priv)779c98411dcSBitterblue Smith static int rtl8192fu_init_phy_rf(struct rtl8xxxu_priv *priv)
780c98411dcSBitterblue Smith {
781c98411dcSBitterblue Smith int ret;
782c98411dcSBitterblue Smith
783c98411dcSBitterblue Smith ret = rtl8xxxu_init_phy_rf(priv, rtl8192fu_radioa_init_table, RF_A);
784c98411dcSBitterblue Smith if (ret)
785c98411dcSBitterblue Smith return ret;
786c98411dcSBitterblue Smith
787c98411dcSBitterblue Smith return rtl8xxxu_init_phy_rf(priv, rtl8192fu_radiob_init_table, RF_B);
788c98411dcSBitterblue Smith }
789c98411dcSBitterblue Smith
rtl8192f_phy_lc_calibrate(struct rtl8xxxu_priv * priv)790c98411dcSBitterblue Smith static void rtl8192f_phy_lc_calibrate(struct rtl8xxxu_priv *priv)
791c98411dcSBitterblue Smith {
792c98411dcSBitterblue Smith u32 backup_mask = BIT(31) | BIT(30);
793c98411dcSBitterblue Smith u32 backup;
794c98411dcSBitterblue Smith u32 val32;
795c98411dcSBitterblue Smith
796c98411dcSBitterblue Smith /* Aries's NarrowBand */
797c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_OFDM0_TX_PSDO_NOISE_WEIGHT);
798c98411dcSBitterblue Smith backup = u32_get_bits(val32, backup_mask);
799c98411dcSBitterblue Smith
800c98411dcSBitterblue Smith u32p_replace_bits(&val32, 0, backup_mask);
801c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TX_PSDO_NOISE_WEIGHT, val32);
802c98411dcSBitterblue Smith
803c98411dcSBitterblue Smith rtl8188f_phy_lc_calibrate(priv);
804c98411dcSBitterblue Smith
805c98411dcSBitterblue Smith /* Aries's NarrowBand */
806c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_OFDM0_TX_PSDO_NOISE_WEIGHT);
807c98411dcSBitterblue Smith u32p_replace_bits(&val32, backup, backup_mask);
808c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TX_PSDO_NOISE_WEIGHT, val32);
809c98411dcSBitterblue Smith
810c98411dcSBitterblue Smith /* reset OFDM state */
811c98411dcSBitterblue Smith rtl8xxxu_write32_clear(priv, REG_FPGA0_RF_MODE, FPGA_RF_MODE_OFDM);
812c98411dcSBitterblue Smith rtl8xxxu_write32_set(priv, REG_FPGA0_RF_MODE, FPGA_RF_MODE_OFDM);
813c98411dcSBitterblue Smith }
814c98411dcSBitterblue Smith
rtl8192fu_iqk_path_a(struct rtl8xxxu_priv * priv)815c98411dcSBitterblue Smith static int rtl8192fu_iqk_path_a(struct rtl8xxxu_priv *priv)
816c98411dcSBitterblue Smith {
817c98411dcSBitterblue Smith u32 reg_eac, reg_e94, reg_e9c, val32;
818c98411dcSBitterblue Smith u32 rf_0x58_i, rf_0x58_q;
819c98411dcSBitterblue Smith u8 rfe = priv->rfe_type;
820c98411dcSBitterblue Smith int result = 0;
821c98411dcSBitterblue Smith int ktime, i;
822c98411dcSBitterblue Smith
823c98411dcSBitterblue Smith /* Leave IQK mode */
824c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
825c98411dcSBitterblue Smith
826c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_ANALOG4, 0xccf000c0);
827c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_ANAPWR1, 0x44ffbb44);
828c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_WAIT_CCA, 0x00400040);
829c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, 0x6f005403);
830c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TR_MUX_PAR, 0x000804e4);
831c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XCD_RF_SW_CTRL, 0x04203400);
832c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XA_HSSI_PARM1, 0x01000100);
833c98411dcSBitterblue Smith
834103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_GAIN_CCA, BIT(4), 1);
835103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_GAIN_CCA, BIT(11), 1);
836c98411dcSBitterblue Smith if (rfe == 7 || rfe == 8 || rfe == 9 || rfe == 12)
837c98411dcSBitterblue Smith val32 = 0x30;
838c98411dcSBitterblue Smith else
839c98411dcSBitterblue Smith val32 = 0xe9;
840103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_PAD_TXG, 0x003ff, val32);
841c98411dcSBitterblue Smith
842c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0x808000);
843c98411dcSBitterblue Smith
844c98411dcSBitterblue Smith /* path-A IQK setting */
845c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x18008c1c);
846c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x38008c1c);
847c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x38008c1c);
848c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
849c98411dcSBitterblue Smith
850c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_PI_A, 0x8214000f);
851c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_PI_A, 0x28140000);
852c98411dcSBitterblue Smith
853c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK, 0x01007c00);
854c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
855c98411dcSBitterblue Smith
856c98411dcSBitterblue Smith /* LO calibration setting */
857c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x00e62911);
858c98411dcSBitterblue Smith
859c98411dcSBitterblue Smith /* One shot, path A LOK & IQK */
860c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xfa005800);
861c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8005800);
862c98411dcSBitterblue Smith
863c98411dcSBitterblue Smith mdelay(15);
864c98411dcSBitterblue Smith
865c98411dcSBitterblue Smith ktime = 0;
866c98411dcSBitterblue Smith while (rtl8xxxu_read32(priv, REG_IQK_RPT_TXA) == 0 && ktime < 21) {
867c98411dcSBitterblue Smith mdelay(5);
868c98411dcSBitterblue Smith ktime += 5;
869c98411dcSBitterblue Smith }
870c98411dcSBitterblue Smith
871c98411dcSBitterblue Smith /* Check failed */
872c98411dcSBitterblue Smith reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
873c98411dcSBitterblue Smith reg_e94 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_A);
874c98411dcSBitterblue Smith reg_e9c = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_A);
875c98411dcSBitterblue Smith
876c98411dcSBitterblue Smith /* reload 0xdf and CCK_IND off */
877c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
878c98411dcSBitterblue Smith
879c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_WE_LUT, BIT(4), 1);
880c98411dcSBitterblue Smith
881c98411dcSBitterblue Smith val32 = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_TXMOD);
882c98411dcSBitterblue Smith rf_0x58_i = u32_get_bits(val32, 0xfc000);
883c98411dcSBitterblue Smith rf_0x58_q = u32_get_bits(val32, 0x003f0);
884c98411dcSBitterblue Smith
885c98411dcSBitterblue Smith for (i = 0; i < 8; i++) {
886c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_TXPA_G3,
887c98411dcSBitterblue Smith 0x1c000, i);
888c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_TXPA_G3,
889c98411dcSBitterblue Smith 0x00fc0, rf_0x58_i);
890c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_TXPA_G3,
891c98411dcSBitterblue Smith 0x0003f, rf_0x58_q);
892c98411dcSBitterblue Smith }
893c98411dcSBitterblue Smith
894c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_AC, BIT(14), 0);
895c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_WE_LUT, BIT(4), 0);
896103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_GAIN_CCA, 0x00810, 0);
897c98411dcSBitterblue Smith
898c98411dcSBitterblue Smith if (!(reg_eac & BIT(28)) &&
899c98411dcSBitterblue Smith ((reg_e94 & 0x03ff0000) != 0x01420000) &&
900c98411dcSBitterblue Smith ((reg_e9c & 0x03ff0000) != 0x00420000))
901c98411dcSBitterblue Smith result |= 0x01;
902c98411dcSBitterblue Smith
903c98411dcSBitterblue Smith return result;
904c98411dcSBitterblue Smith }
905c98411dcSBitterblue Smith
rtl8192fu_rx_iqk_path_a(struct rtl8xxxu_priv * priv)906c98411dcSBitterblue Smith static int rtl8192fu_rx_iqk_path_a(struct rtl8xxxu_priv *priv)
907c98411dcSBitterblue Smith {
908c98411dcSBitterblue Smith u32 reg_ea4, reg_eac, reg_e94, reg_e9c, val32;
909c98411dcSBitterblue Smith int result = 0;
910c98411dcSBitterblue Smith int ktime;
911c98411dcSBitterblue Smith
912c98411dcSBitterblue Smith /* Leave IQK mode */
913c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
914c98411dcSBitterblue Smith
915c98411dcSBitterblue Smith /* PA/PAD control by 0x56, and set = 0x0 */
916103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_GAIN_CCA, BIT(1), 1);
917c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_GAIN_P1, 0);
918103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_GAIN_CCA, BIT(11), 1);
919103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_PAD_TXG, 0x003ff, 0x27);
920c98411dcSBitterblue Smith
921c98411dcSBitterblue Smith /* Enter IQK mode */
922c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0x808000);
923c98411dcSBitterblue Smith
924c98411dcSBitterblue Smith /* path-A IQK setting */
925c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x18008c1c);
926c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x38008c1c);
927c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x38008c1c);
928c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
929c98411dcSBitterblue Smith
930c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_PI_A, 0x82160027);
931c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_PI_A, 0x28160000);
932c98411dcSBitterblue Smith
933c98411dcSBitterblue Smith /* Tx IQK setting */
934c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK, 0x01007c00);
935c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
936c98411dcSBitterblue Smith
937c98411dcSBitterblue Smith /* LO calibration setting */
938c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x0086a911);
939c98411dcSBitterblue Smith
940c98411dcSBitterblue Smith /* One shot, path A LOK & IQK */
941c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xfa005800);
942c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8005800);
943c98411dcSBitterblue Smith
944c98411dcSBitterblue Smith mdelay(15);
945c98411dcSBitterblue Smith
946c98411dcSBitterblue Smith ktime = 0;
947c98411dcSBitterblue Smith while (rtl8xxxu_read32(priv, REG_IQK_RPT_TXA) == 0 && ktime < 21) {
948c98411dcSBitterblue Smith mdelay(5);
949c98411dcSBitterblue Smith ktime += 5;
950c98411dcSBitterblue Smith }
951c98411dcSBitterblue Smith
952c98411dcSBitterblue Smith /* Check failed */
953c98411dcSBitterblue Smith reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
954c98411dcSBitterblue Smith reg_e94 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_A);
955c98411dcSBitterblue Smith reg_e9c = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_A);
956c98411dcSBitterblue Smith
957c98411dcSBitterblue Smith if (!(reg_eac & BIT(28)) &&
958c98411dcSBitterblue Smith ((reg_e94 & 0x03ff0000) != 0x01420000) &&
959c98411dcSBitterblue Smith ((reg_e9c & 0x03ff0000) != 0x00420000)) {
960c98411dcSBitterblue Smith result |= 0x01;
961c98411dcSBitterblue Smith } else { /* If TX not OK, ignore RX */
962c98411dcSBitterblue Smith /* PA/PAD controlled by 0x0 */
963c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
964c98411dcSBitterblue Smith
965103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_GAIN_CCA,
966c98411dcSBitterblue Smith BIT(11), 0);
967c98411dcSBitterblue Smith
968c98411dcSBitterblue Smith return result;
969c98411dcSBitterblue Smith }
970c98411dcSBitterblue Smith
971c98411dcSBitterblue Smith val32 = 0x80007c00 | (reg_e94 & 0x3ff0000) | ((reg_e9c & 0x3ff0000) >> 16);
972c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK, val32);
973c98411dcSBitterblue Smith
974c98411dcSBitterblue Smith /* Modify RX IQK mode table */
975c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
976c98411dcSBitterblue Smith
977c98411dcSBitterblue Smith /* PA/PAD control by 0x56, and set = 0x0 */
978103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_GAIN_CCA, BIT(1), 1);
979c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_GAIN_P1, 0);
980103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_GAIN_CCA, BIT(11), 1);
981103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_PAD_TXG, 0x003ff, 0x1e0);
982c98411dcSBitterblue Smith
983c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_ANALOG4, 0xccf000c0);
984c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_ANAPWR1, 0x44ffbb44);
985c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_WAIT_CCA, 0x00400040);
986c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, 0x6f005403);
987c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TR_MUX_PAR, 0x000804e4);
988c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XCD_RF_SW_CTRL, 0x04203400);
989c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XA_HSSI_PARM1, 0x01000100);
990c98411dcSBitterblue Smith
991c98411dcSBitterblue Smith /* Enter IQK mode */
992c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0x808000);
993c98411dcSBitterblue Smith
994c98411dcSBitterblue Smith /* path-A IQK setting */
995c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x38008c1c);
996c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x18008c1c);
997c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x38008c1c);
998c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
999c98411dcSBitterblue Smith
1000c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_PI_A, 0x82170000);
1001c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_PI_A, 0x28170000);
1002c98411dcSBitterblue Smith
1003c98411dcSBitterblue Smith /* RX IQK setting */
1004c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
1005c98411dcSBitterblue Smith
1006c98411dcSBitterblue Smith /* LO calibration setting */
1007c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x0046a8d1);
1008c98411dcSBitterblue Smith
1009c98411dcSBitterblue Smith /* One shot, path A LOK & IQK */
1010c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xfa005800);
1011c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8005800);
1012c98411dcSBitterblue Smith
1013c98411dcSBitterblue Smith mdelay(15);
1014c98411dcSBitterblue Smith
1015c98411dcSBitterblue Smith ktime = 0;
1016c98411dcSBitterblue Smith while (rtl8xxxu_read32(priv, REG_IQK_RPT_RXA) == 0 && ktime < 21) {
1017c98411dcSBitterblue Smith mdelay(5);
1018c98411dcSBitterblue Smith ktime += 5;
1019c98411dcSBitterblue Smith }
1020c98411dcSBitterblue Smith
1021c98411dcSBitterblue Smith /* Check failed */
1022c98411dcSBitterblue Smith reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
1023c98411dcSBitterblue Smith reg_ea4 = rtl8xxxu_read32(priv, REG_RX_POWER_BEFORE_IQK_A_2);
1024c98411dcSBitterblue Smith
1025c98411dcSBitterblue Smith /* Leave IQK mode */
1026c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
1027c98411dcSBitterblue Smith
1028103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_A, RF6052_REG_GAIN_CCA, BIT(11), 0);
1029c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_GAIN_P1, 0x02000);
1030c98411dcSBitterblue Smith
1031c98411dcSBitterblue Smith if (!(reg_eac & BIT(27)) &&
1032c98411dcSBitterblue Smith ((reg_ea4 & 0x03ff0000) != 0x01320000) &&
1033c98411dcSBitterblue Smith ((reg_eac & 0x03ff0000) != 0x00360000))
1034c98411dcSBitterblue Smith result |= 0x02;
1035c98411dcSBitterblue Smith
1036c98411dcSBitterblue Smith return result;
1037c98411dcSBitterblue Smith }
1038c98411dcSBitterblue Smith
rtl8192fu_iqk_path_b(struct rtl8xxxu_priv * priv)1039c98411dcSBitterblue Smith static int rtl8192fu_iqk_path_b(struct rtl8xxxu_priv *priv)
1040c98411dcSBitterblue Smith {
1041c98411dcSBitterblue Smith u32 reg_eac, reg_eb4, reg_ebc, val32;
1042c98411dcSBitterblue Smith u32 rf_0x58_i, rf_0x58_q;
1043c98411dcSBitterblue Smith u8 rfe = priv->rfe_type;
1044c98411dcSBitterblue Smith int result = 0;
1045c98411dcSBitterblue Smith int ktime, i;
1046c98411dcSBitterblue Smith
1047c98411dcSBitterblue Smith /* PA/PAD controlled by 0x0 */
1048c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
1049c98411dcSBitterblue Smith
1050c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_ANALOG4, 0xccf000c0);
1051c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_ANAPWR1, 0x44ffbb44);
1052c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_WAIT_CCA, 0x00400040);
1053c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, 0x6f005403);
1054c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TR_MUX_PAR, 0x000804e4);
1055c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XCD_RF_SW_CTRL, 0x04203400);
1056c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XA_HSSI_PARM1, 0x01000000);
1057c98411dcSBitterblue Smith
1058103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_GAIN_CCA, BIT(4), 1);
1059103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_GAIN_CCA, BIT(11), 1);
1060c98411dcSBitterblue Smith if (rfe == 7 || rfe == 8 || rfe == 9 || rfe == 12)
1061103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_PAD_TXG,
1062c98411dcSBitterblue Smith 0x003ff, 0x30);
1063c98411dcSBitterblue Smith else
1064103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_PAD_TXG,
1065c98411dcSBitterblue Smith 0x00fff, 0xe9);
1066c98411dcSBitterblue Smith
1067c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0x808000);
1068c98411dcSBitterblue Smith
1069c98411dcSBitterblue Smith /* Path B IQK setting */
1070c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x38008c1c);
1071c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x38008c1c);
1072c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x18008c1c);
1073c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
1074c98411dcSBitterblue Smith
1075c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_PI_B, 0x8214000F);
1076c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_PI_B, 0x28140000);
1077c98411dcSBitterblue Smith
1078c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK, 0x01007c00);
1079c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
1080c98411dcSBitterblue Smith
1081c98411dcSBitterblue Smith /* LO calibration setting */
1082c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x00e62911);
1083c98411dcSBitterblue Smith
1084c98411dcSBitterblue Smith /* One shot, path B LOK & IQK */
1085c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xfa005800);
1086c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8005800);
1087c98411dcSBitterblue Smith
1088c98411dcSBitterblue Smith mdelay(15);
1089c98411dcSBitterblue Smith
1090c98411dcSBitterblue Smith ktime = 0;
1091c98411dcSBitterblue Smith while (rtl8xxxu_read32(priv, REG_IQK_RPT_TXB) == 0 && ktime < 21) {
1092c98411dcSBitterblue Smith mdelay(5);
1093c98411dcSBitterblue Smith ktime += 5;
1094c98411dcSBitterblue Smith }
1095c98411dcSBitterblue Smith
1096c98411dcSBitterblue Smith /* Check failed */
1097c98411dcSBitterblue Smith reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
1098c98411dcSBitterblue Smith reg_eb4 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_B);
1099c98411dcSBitterblue Smith reg_ebc = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_B);
1100c98411dcSBitterblue Smith
1101c98411dcSBitterblue Smith /* reload 0xdf and CCK_IND off */
1102c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
1103c98411dcSBitterblue Smith
1104c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_WE_LUT, BIT(4), 1);
1105c98411dcSBitterblue Smith
1106c98411dcSBitterblue Smith val32 = rtl8xxxu_read_rfreg(priv, RF_B, RF6052_REG_TXMOD);
1107c98411dcSBitterblue Smith rf_0x58_i = u32_get_bits(val32, 0xfc000);
1108c98411dcSBitterblue Smith rf_0x58_q = u32_get_bits(val32, 0x003f0);
1109c98411dcSBitterblue Smith
1110c98411dcSBitterblue Smith for (i = 0; i < 8; i++) {
1111c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_TXPA_G3,
1112c98411dcSBitterblue Smith 0x1c000, i);
1113c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_TXPA_G3,
1114c98411dcSBitterblue Smith 0x00fc0, rf_0x58_i);
1115c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_TXPA_G3,
1116c98411dcSBitterblue Smith 0x0003f, rf_0x58_q);
1117c98411dcSBitterblue Smith }
1118c98411dcSBitterblue Smith
1119c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_AC, BIT(14), 0);
1120c98411dcSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_WE_LUT, BIT(4), 0);
1121103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_GAIN_CCA, 0x00810, 0);
1122c98411dcSBitterblue Smith
1123c98411dcSBitterblue Smith if (!(reg_eac & BIT(31)) &&
1124c98411dcSBitterblue Smith ((reg_eb4 & 0x03ff0000) != 0x01420000) &&
1125c98411dcSBitterblue Smith ((reg_ebc & 0x03ff0000) != 0x00420000))
1126c98411dcSBitterblue Smith result |= 0x01;
1127c98411dcSBitterblue Smith else
1128c98411dcSBitterblue Smith dev_warn(&priv->udev->dev, "%s: Path B IQK failed!\n",
1129c98411dcSBitterblue Smith __func__);
1130c98411dcSBitterblue Smith
1131c98411dcSBitterblue Smith return result;
1132c98411dcSBitterblue Smith }
1133c98411dcSBitterblue Smith
rtl8192fu_rx_iqk_path_b(struct rtl8xxxu_priv * priv)1134c98411dcSBitterblue Smith static int rtl8192fu_rx_iqk_path_b(struct rtl8xxxu_priv *priv)
1135c98411dcSBitterblue Smith {
1136c98411dcSBitterblue Smith u32 reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc, val32;
1137c98411dcSBitterblue Smith int result = 0;
1138c98411dcSBitterblue Smith int ktime;
1139c98411dcSBitterblue Smith
1140c98411dcSBitterblue Smith /* Leave IQK mode */
1141c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
1142c98411dcSBitterblue Smith
1143103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_GAIN_CCA, BIT(1), 1);
1144c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_GAIN_P1, 0);
1145103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_GAIN_CCA, BIT(11), 1);
1146103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_PAD_TXG, 0x003ff, 0x67);
1147c98411dcSBitterblue Smith
1148c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_ANALOG4, 0xccf000c0);
1149c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_ANAPWR1, 0x44ffbb44);
1150c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_WAIT_CCA, 0x00400040);
1151c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, 0x6f005403);
1152c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TR_MUX_PAR, 0x000804e4);
1153c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XCD_RF_SW_CTRL, 0x04203400);
1154c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XA_HSSI_PARM1, 0x01000000);
1155c98411dcSBitterblue Smith
1156c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0x808000);
1157c98411dcSBitterblue Smith
1158c98411dcSBitterblue Smith /* path-B IQK setting */
1159c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x38008c1c);
1160c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x38008c1c);
1161c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x18008c1c);
1162c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x38008c1c);
1163c98411dcSBitterblue Smith
1164c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_PI_B, 0x82160027);
1165c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_PI_B, 0x28160000);
1166c98411dcSBitterblue Smith
1167c98411dcSBitterblue Smith /* LO calibration setting */
1168c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x0086a911);
1169c98411dcSBitterblue Smith
1170c98411dcSBitterblue Smith /* One shot, path A LOK & IQK */
1171c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xfa005800);
1172c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8005800);
1173c98411dcSBitterblue Smith
1174c98411dcSBitterblue Smith mdelay(15);
1175c98411dcSBitterblue Smith
1176c98411dcSBitterblue Smith ktime = 0;
1177c98411dcSBitterblue Smith while (rtl8xxxu_read32(priv, REG_IQK_RPT_TXB) == 0 && ktime < 21) {
1178c98411dcSBitterblue Smith mdelay(5);
1179c98411dcSBitterblue Smith ktime += 5;
1180c98411dcSBitterblue Smith }
1181c98411dcSBitterblue Smith
1182c98411dcSBitterblue Smith /* Check failed */
1183c98411dcSBitterblue Smith reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
1184c98411dcSBitterblue Smith reg_eb4 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_B);
1185c98411dcSBitterblue Smith reg_ebc = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_B);
1186c98411dcSBitterblue Smith
1187c98411dcSBitterblue Smith if (!(reg_eac & BIT(31)) &&
1188c98411dcSBitterblue Smith ((reg_eb4 & 0x03ff0000) != 0x01420000) &&
1189c98411dcSBitterblue Smith ((reg_ebc & 0x03ff0000) != 0x00420000)) {
1190c98411dcSBitterblue Smith result |= 0x01;
1191c98411dcSBitterblue Smith } else {
1192c98411dcSBitterblue Smith /* PA/PAD controlled by 0x0 */
1193c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
1194c98411dcSBitterblue Smith
1195103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_GAIN_CCA,
1196c98411dcSBitterblue Smith BIT(11), 0);
1197c98411dcSBitterblue Smith
1198c98411dcSBitterblue Smith return result;
1199c98411dcSBitterblue Smith }
1200c98411dcSBitterblue Smith
1201c98411dcSBitterblue Smith val32 = 0x80007c00 | (reg_eb4 & 0x03ff0000) | ((reg_ebc >> 16) & 0x03ff);
1202c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK, val32);
1203c98411dcSBitterblue Smith
1204c98411dcSBitterblue Smith /* Modify RX IQK mode table */
1205c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
1206c98411dcSBitterblue Smith
1207103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_GAIN_CCA, BIT(1), 1);
1208c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_GAIN_P1, 0);
1209103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_GAIN_CCA, BIT(11), 1);
1210103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_PAD_TXG, 0x003ff, 0x1e0);
1211c98411dcSBitterblue Smith
1212c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_ANALOG4, 0xccf000c0);
1213c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_ANAPWR1, 0x44ffbb44);
1214c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_WAIT_CCA, 0x00400040);
1215c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, 0x6f005403);
1216c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TR_MUX_PAR, 0x000804e4);
1217c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XCD_RF_SW_CTRL, 0x04203400);
1218c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XA_HSSI_PARM1, 0x01000000);
1219c98411dcSBitterblue Smith
1220c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0x808000);
1221c98411dcSBitterblue Smith
1222c98411dcSBitterblue Smith /* Path B IQK setting */
1223c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_TONE_A, 0x38008c1c);
1224c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_TONE_A, 0x38008c1c);
1225c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_TONE_B, 0x38008c1c);
1226c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_TONE_B, 0x18008c1c);
1227c98411dcSBitterblue Smith
1228c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_TX_IQK_PI_B, 0x82170000);
1229c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK_PI_B, 0x28170000);
1230c98411dcSBitterblue Smith
1231c98411dcSBitterblue Smith /* IQK setting */
1232c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_IQK, 0x01004800);
1233c98411dcSBitterblue Smith
1234c98411dcSBitterblue Smith /* LO calibration setting */
1235c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_RSP, 0x0046a911);
1236c98411dcSBitterblue Smith
1237c98411dcSBitterblue Smith /* One shot, path A LOK & IQK */
1238c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xfa005800);
1239c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_IQK_AGC_PTS, 0xf8005800);
1240c98411dcSBitterblue Smith
1241c98411dcSBitterblue Smith mdelay(15);
1242c98411dcSBitterblue Smith
1243c98411dcSBitterblue Smith ktime = 0;
1244c98411dcSBitterblue Smith while (rtl8xxxu_read32(priv, REG_IQK_RPT_RXB) == 0 && ktime < 21) {
1245c98411dcSBitterblue Smith mdelay(5);
1246c98411dcSBitterblue Smith ktime += 5;
1247c98411dcSBitterblue Smith }
1248c98411dcSBitterblue Smith
1249c98411dcSBitterblue Smith reg_eac = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
1250c98411dcSBitterblue Smith reg_ec4 = rtl8xxxu_read32(priv, REG_RX_POWER_BEFORE_IQK_B_2);
1251c98411dcSBitterblue Smith reg_ecc = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_B_2);
1252c98411dcSBitterblue Smith
1253c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
1254c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XA_HSSI_PARM1, 0x01000100);
1255c98411dcSBitterblue Smith
1256103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_GAIN_CCA, BIT(11), 0);
1257103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg_mask(priv, RF_B, RF6052_REG_GAIN_CCA, BIT(1), 0);
1258c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_GAIN_P1, 0x02000);
1259c98411dcSBitterblue Smith
1260c98411dcSBitterblue Smith if (!(reg_eac & BIT(30)) &&
1261c98411dcSBitterblue Smith ((reg_ec4 & 0x03ff0000) != 0x01320000) &&
1262c98411dcSBitterblue Smith ((reg_ecc & 0x03ff0000) != 0x00360000))
1263c98411dcSBitterblue Smith result |= 0x02;
1264c98411dcSBitterblue Smith else
1265c98411dcSBitterblue Smith dev_warn(&priv->udev->dev, "%s: Path B RX IQK failed!\n",
1266c98411dcSBitterblue Smith __func__);
1267c98411dcSBitterblue Smith
1268c98411dcSBitterblue Smith return result;
1269c98411dcSBitterblue Smith }
1270c98411dcSBitterblue Smith
rtl8192fu_phy_iqcalibrate(struct rtl8xxxu_priv * priv,int result[][8],int t)1271c98411dcSBitterblue Smith static void rtl8192fu_phy_iqcalibrate(struct rtl8xxxu_priv *priv,
1272c98411dcSBitterblue Smith int result[][8], int t)
1273c98411dcSBitterblue Smith {
1274c98411dcSBitterblue Smith static const u32 adda_regs[2] = {
1275c98411dcSBitterblue Smith REG_ANAPWR1, REG_RX_WAIT_CCA
1276c98411dcSBitterblue Smith };
1277c98411dcSBitterblue Smith static const u32 iqk_mac_regs[RTL8XXXU_MAC_REGS] = {
1278c98411dcSBitterblue Smith REG_TXPAUSE, REG_BEACON_CTRL,
1279c98411dcSBitterblue Smith REG_BEACON_CTRL_1, REG_GPIO_MUXCFG
1280c98411dcSBitterblue Smith };
1281c98411dcSBitterblue Smith static const u32 iqk_bb_regs[RTL8XXXU_BB_REGS] = {
1282c98411dcSBitterblue Smith REG_OFDM0_TRX_PATH_ENABLE, REG_OFDM0_TR_MUX_PAR,
1283c98411dcSBitterblue Smith REG_FPGA0_XCD_RF_SW_CTRL, REG_CONFIG_ANT_A, REG_CONFIG_ANT_B,
1284c98411dcSBitterblue Smith REG_DPDT_CTRL, REG_RFE_CTRL_ANTA_SRC,
1285c98411dcSBitterblue Smith REG_RFE_CTRL_ANT_SRC2, REG_CCK0_AFE_SETTING
1286c98411dcSBitterblue Smith };
1287c98411dcSBitterblue Smith u32 rx_initial_gain_a, rx_initial_gain_b;
1288c98411dcSBitterblue Smith struct device *dev = &priv->udev->dev;
1289c98411dcSBitterblue Smith int path_a_ok, path_b_ok;
1290c98411dcSBitterblue Smith u8 rfe = priv->rfe_type;
1291c98411dcSBitterblue Smith int retry = 2;
1292c98411dcSBitterblue Smith u32 i, val32;
1293c98411dcSBitterblue Smith
1294c98411dcSBitterblue Smith /*
1295c98411dcSBitterblue Smith * Note: IQ calibration must be performed after loading
1296c98411dcSBitterblue Smith * PHY_REG.txt , and radio_a, radio_b.txt
1297c98411dcSBitterblue Smith */
1298c98411dcSBitterblue Smith
1299c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
1300c98411dcSBitterblue Smith
1301c98411dcSBitterblue Smith rx_initial_gain_a = rtl8xxxu_read32(priv, REG_OFDM0_XA_AGC_CORE1);
1302c98411dcSBitterblue Smith rx_initial_gain_b = rtl8xxxu_read32(priv, REG_OFDM0_XB_AGC_CORE1);
1303c98411dcSBitterblue Smith
1304c98411dcSBitterblue Smith if (t == 0) {
1305c98411dcSBitterblue Smith /* Save ADDA parameters, turn Path A ADDA on */
1306c98411dcSBitterblue Smith rtl8xxxu_save_regs(priv, adda_regs, priv->adda_backup,
1307c98411dcSBitterblue Smith ARRAY_SIZE(adda_regs));
1308c98411dcSBitterblue Smith rtl8xxxu_save_mac_regs(priv, iqk_mac_regs, priv->mac_backup);
1309c98411dcSBitterblue Smith rtl8xxxu_save_regs(priv, iqk_bb_regs,
1310c98411dcSBitterblue Smith priv->bb_backup, RTL8XXXU_BB_REGS);
1311c98411dcSBitterblue Smith }
1312c98411dcSBitterblue Smith
1313c98411dcSBitterblue Smith /* Instead of rtl8xxxu_path_adda_on */
1314c98411dcSBitterblue Smith rtl8xxxu_write32_set(priv, REG_FPGA0_XCD_RF_PARM, BIT(31));
1315c98411dcSBitterblue Smith
1316c98411dcSBitterblue Smith /* MAC settings */
1317c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_TXPAUSE, 0xff);
1318c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_GPIO_MUXCFG, GPIO_MUXCFG_IO_SEL_ENBT);
1319c98411dcSBitterblue Smith
1320c98411dcSBitterblue Smith if (rfe == 7 || rfe == 8 || rfe == 9 || rfe == 12) {
1321c98411dcSBitterblue Smith /* in ePA IQK, rfe_func_config & SW both pull down */
1322c98411dcSBitterblue Smith /* path A */
1323c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANTA_SRC, 0xF, 0x7);
1324c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_DPDT_CTRL, 0x1, 0x0);
1325c98411dcSBitterblue Smith
1326c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANTA_SRC, 0xF00, 0x7);
1327c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_DPDT_CTRL, 0x4, 0x0);
1328c98411dcSBitterblue Smith
1329c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANTA_SRC, 0xF000, 0x7);
1330c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_DPDT_CTRL, 0x8, 0x0);
1331c98411dcSBitterblue Smith
1332c98411dcSBitterblue Smith /* path B */
1333c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANT_SRC2, 0xF0, 0x7);
1334c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_DPDT_CTRL, 0x20000, 0x0);
1335c98411dcSBitterblue Smith
1336c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANT_SRC2, 0xF0000, 0x7);
1337c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_DPDT_CTRL, 0x100000, 0x0);
1338c98411dcSBitterblue Smith
1339c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANT_SRC3, 0xF000, 0x7);
1340c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_DPDT_CTRL, 0x8000000, 0x0);
1341c98411dcSBitterblue Smith }
1342c98411dcSBitterblue Smith
1343c98411dcSBitterblue Smith if (priv->rf_paths > 1) {
1344c98411dcSBitterblue Smith /* path B standby */
1345c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0x000000);
1346c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_AC, 0x10000);
1347c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0x808000);
1348c98411dcSBitterblue Smith }
1349c98411dcSBitterblue Smith
1350c98411dcSBitterblue Smith for (i = 0; i < retry; i++) {
1351c98411dcSBitterblue Smith path_a_ok = rtl8192fu_iqk_path_a(priv);
1352c98411dcSBitterblue Smith
1353c98411dcSBitterblue Smith if (path_a_ok == 0x01) {
1354c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_A);
1355c98411dcSBitterblue Smith result[t][0] = (val32 >> 16) & 0x3ff;
1356c98411dcSBitterblue Smith
1357c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_A);
1358c98411dcSBitterblue Smith result[t][1] = (val32 >> 16) & 0x3ff;
1359c98411dcSBitterblue Smith break;
1360c98411dcSBitterblue Smith } else {
1361c98411dcSBitterblue Smith result[t][0] = 0x100;
1362c98411dcSBitterblue Smith result[t][1] = 0x0;
1363c98411dcSBitterblue Smith }
1364c98411dcSBitterblue Smith }
1365c98411dcSBitterblue Smith
1366c98411dcSBitterblue Smith for (i = 0; i < retry; i++) {
1367c98411dcSBitterblue Smith path_a_ok = rtl8192fu_rx_iqk_path_a(priv);
1368c98411dcSBitterblue Smith
1369c98411dcSBitterblue Smith if (path_a_ok == 0x03) {
1370c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_RX_POWER_BEFORE_IQK_A_2);
1371c98411dcSBitterblue Smith result[t][2] = (val32 >> 16) & 0x3ff;
1372c98411dcSBitterblue Smith
1373c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_A_2);
1374c98411dcSBitterblue Smith result[t][3] = (val32 >> 16) & 0x3ff;
1375c98411dcSBitterblue Smith break;
1376c98411dcSBitterblue Smith } else {
1377c98411dcSBitterblue Smith result[t][2] = 0x100;
1378c98411dcSBitterblue Smith result[t][3] = 0x0;
1379c98411dcSBitterblue Smith }
1380c98411dcSBitterblue Smith }
1381c98411dcSBitterblue Smith
1382c98411dcSBitterblue Smith if (!path_a_ok)
1383c98411dcSBitterblue Smith dev_warn(dev, "%s: Path A IQK failed!\n", __func__);
1384c98411dcSBitterblue Smith
1385c98411dcSBitterblue Smith if (priv->rf_paths > 1) {
1386c98411dcSBitterblue Smith for (i = 0; i < retry; i++) {
1387c98411dcSBitterblue Smith path_b_ok = rtl8192fu_iqk_path_b(priv);
1388c98411dcSBitterblue Smith
1389c98411dcSBitterblue Smith if (path_b_ok == 0x01) {
1390c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_TX_POWER_BEFORE_IQK_B);
1391c98411dcSBitterblue Smith result[t][4] = (val32 >> 16) & 0x3ff;
1392c98411dcSBitterblue Smith
1393c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_TX_POWER_AFTER_IQK_B);
1394c98411dcSBitterblue Smith result[t][5] = (val32 >> 16) & 0x3ff;
1395c98411dcSBitterblue Smith break;
1396c98411dcSBitterblue Smith } else {
1397c98411dcSBitterblue Smith result[t][4] = 0x100;
1398c98411dcSBitterblue Smith result[t][5] = 0x0;
1399c98411dcSBitterblue Smith }
1400c98411dcSBitterblue Smith }
1401c98411dcSBitterblue Smith
1402c98411dcSBitterblue Smith for (i = 0; i < retry; i++) {
1403c98411dcSBitterblue Smith path_b_ok = rtl8192fu_rx_iqk_path_b(priv);
1404c98411dcSBitterblue Smith
1405c98411dcSBitterblue Smith if (path_b_ok == 0x03) {
1406c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_RX_POWER_BEFORE_IQK_B_2);
1407c98411dcSBitterblue Smith result[t][6] = (val32 >> 16) & 0x3ff;
1408c98411dcSBitterblue Smith
1409c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_RX_POWER_AFTER_IQK_B_2);
1410c98411dcSBitterblue Smith result[t][7] = (val32 >> 16) & 0x3ff;
1411c98411dcSBitterblue Smith break;
1412c98411dcSBitterblue Smith } else {
1413c98411dcSBitterblue Smith result[t][6] = 0x100;
1414c98411dcSBitterblue Smith result[t][7] = 0x0;
1415c98411dcSBitterblue Smith }
1416c98411dcSBitterblue Smith }
1417c98411dcSBitterblue Smith
1418c98411dcSBitterblue Smith if (!path_b_ok)
1419c98411dcSBitterblue Smith dev_warn(dev, "%s: Path B IQK failed!\n", __func__);
1420c98411dcSBitterblue Smith }
1421c98411dcSBitterblue Smith
1422c98411dcSBitterblue Smith /* Back to BB mode, load original value */
1423c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_FPGA0_IQK, 0xffffff00, 0);
1424c98411dcSBitterblue Smith
1425c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_ANALOG4, 0xcc0000c0);
1426c98411dcSBitterblue Smith
1427c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_ANAPWR1, 0x44bbbb44);
1428c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RX_WAIT_CCA, 0x80408040);
1429c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, 0x6f005433);
1430c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TR_MUX_PAR, 0x000004e4);
1431c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XCD_RF_SW_CTRL, 0x04003400);
1432c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_FPGA0_XA_HSSI_PARM1, 0x01000100);
1433c98411dcSBitterblue Smith
1434c98411dcSBitterblue Smith /* Reload ADDA power saving parameters */
1435c98411dcSBitterblue Smith rtl8xxxu_restore_regs(priv, adda_regs, priv->adda_backup,
1436c98411dcSBitterblue Smith ARRAY_SIZE(adda_regs));
1437c98411dcSBitterblue Smith
1438c98411dcSBitterblue Smith /* Reload MAC parameters */
1439c98411dcSBitterblue Smith rtl8xxxu_restore_mac_regs(priv, iqk_mac_regs, priv->mac_backup);
1440c98411dcSBitterblue Smith
1441c98411dcSBitterblue Smith /* Reload BB parameters */
1442c98411dcSBitterblue Smith rtl8xxxu_restore_regs(priv, iqk_bb_regs, priv->bb_backup, RTL8XXXU_BB_REGS);
1443c98411dcSBitterblue Smith
1444c98411dcSBitterblue Smith rtl8xxxu_write32_clear(priv, REG_FPGA0_XCD_RF_PARM, BIT(31));
1445c98411dcSBitterblue Smith
1446c98411dcSBitterblue Smith /* Restore RX initial gain */
1447c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_OFDM0_XA_AGC_CORE1, 0xff, 0x50);
1448c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_OFDM0_XA_AGC_CORE1, 0xff,
1449c98411dcSBitterblue Smith rx_initial_gain_a & 0xff);
1450c98411dcSBitterblue Smith if (priv->rf_paths > 1) {
1451c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_OFDM0_XB_AGC_CORE1, 0xff, 0x50);
1452c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_OFDM0_XB_AGC_CORE1, 0xff,
1453c98411dcSBitterblue Smith rx_initial_gain_b & 0xff);
1454c98411dcSBitterblue Smith }
1455c98411dcSBitterblue Smith }
1456c98411dcSBitterblue Smith
rtl8192fu_phy_iq_calibrate(struct rtl8xxxu_priv * priv)1457c98411dcSBitterblue Smith static void rtl8192fu_phy_iq_calibrate(struct rtl8xxxu_priv *priv)
1458c98411dcSBitterblue Smith {
1459c98411dcSBitterblue Smith s32 reg_e94, reg_e9c, reg_ea4, reg_eac;
1460c98411dcSBitterblue Smith s32 reg_eb4, reg_ebc, reg_ec4, reg_ecc;
1461c98411dcSBitterblue Smith struct device *dev = &priv->udev->dev;
1462c98411dcSBitterblue Smith u32 path_a_0xdf, path_a_0x35;
1463c98411dcSBitterblue Smith u32 path_b_0xdf, path_b_0x35;
1464c98411dcSBitterblue Smith bool path_a_ok, path_b_ok;
1465c98411dcSBitterblue Smith u8 rfe = priv->rfe_type;
1466c98411dcSBitterblue Smith u32 rfe_path_select;
1467c98411dcSBitterblue Smith int result[4][8]; /* last is final result */
1468c98411dcSBitterblue Smith int i, candidate;
1469c98411dcSBitterblue Smith s32 reg_tmp = 0;
1470c98411dcSBitterblue Smith bool simu;
1471c98411dcSBitterblue Smith u32 val32;
1472c98411dcSBitterblue Smith
1473c98411dcSBitterblue Smith rfe_path_select = rtl8xxxu_read32(priv, REG_RFE_PATH_SELECT);
1474c98411dcSBitterblue Smith
1475103d6e9dSBitterblue Smith path_a_0xdf = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_GAIN_CCA);
1476c98411dcSBitterblue Smith path_a_0x35 = rtl8xxxu_read_rfreg(priv, RF_A, RF6052_REG_GAIN_P1);
1477103d6e9dSBitterblue Smith path_b_0xdf = rtl8xxxu_read_rfreg(priv, RF_B, RF6052_REG_GAIN_CCA);
1478c98411dcSBitterblue Smith path_b_0x35 = rtl8xxxu_read_rfreg(priv, RF_B, RF6052_REG_GAIN_P1);
1479c98411dcSBitterblue Smith
1480c98411dcSBitterblue Smith memset(result, 0, sizeof(result));
1481c98411dcSBitterblue Smith candidate = -1;
1482c98411dcSBitterblue Smith
1483c98411dcSBitterblue Smith path_a_ok = false;
1484c98411dcSBitterblue Smith path_b_ok = false;
1485c98411dcSBitterblue Smith
1486c98411dcSBitterblue Smith for (i = 0; i < 3; i++) {
1487c98411dcSBitterblue Smith rtl8192fu_phy_iqcalibrate(priv, result, i);
1488c98411dcSBitterblue Smith
1489c98411dcSBitterblue Smith if (i == 1) {
1490c98411dcSBitterblue Smith simu = rtl8xxxu_gen2_simularity_compare(priv, result, 0, 1);
1491c98411dcSBitterblue Smith if (simu) {
1492c98411dcSBitterblue Smith candidate = 0;
1493c98411dcSBitterblue Smith break;
1494c98411dcSBitterblue Smith }
1495c98411dcSBitterblue Smith }
1496c98411dcSBitterblue Smith
1497c98411dcSBitterblue Smith if (i == 2) {
1498c98411dcSBitterblue Smith simu = rtl8xxxu_gen2_simularity_compare(priv, result, 0, 2);
1499c98411dcSBitterblue Smith if (simu) {
1500c98411dcSBitterblue Smith candidate = 0;
1501c98411dcSBitterblue Smith break;
1502c98411dcSBitterblue Smith }
1503c98411dcSBitterblue Smith
1504c98411dcSBitterblue Smith simu = rtl8xxxu_gen2_simularity_compare(priv, result, 1, 2);
1505c98411dcSBitterblue Smith if (simu) {
1506c98411dcSBitterblue Smith candidate = 1;
1507c98411dcSBitterblue Smith } else {
1508c98411dcSBitterblue Smith for (i = 0; i < 8; i++)
1509c98411dcSBitterblue Smith reg_tmp += result[3][i];
1510c98411dcSBitterblue Smith
1511c98411dcSBitterblue Smith if (reg_tmp)
1512c98411dcSBitterblue Smith candidate = 3;
1513c98411dcSBitterblue Smith else
1514c98411dcSBitterblue Smith candidate = -1;
1515c98411dcSBitterblue Smith }
1516c98411dcSBitterblue Smith }
1517c98411dcSBitterblue Smith }
1518c98411dcSBitterblue Smith
1519c98411dcSBitterblue Smith if (candidate >= 0) {
1520c98411dcSBitterblue Smith reg_e94 = result[candidate][0];
1521c98411dcSBitterblue Smith reg_e9c = result[candidate][1];
1522c98411dcSBitterblue Smith reg_ea4 = result[candidate][2];
1523c98411dcSBitterblue Smith reg_eac = result[candidate][3];
1524c98411dcSBitterblue Smith reg_eb4 = result[candidate][4];
1525c98411dcSBitterblue Smith reg_ebc = result[candidate][5];
1526c98411dcSBitterblue Smith reg_ec4 = result[candidate][6];
1527c98411dcSBitterblue Smith reg_ecc = result[candidate][7];
1528c98411dcSBitterblue Smith
1529c98411dcSBitterblue Smith dev_dbg(dev, "%s: candidate is %x\n", __func__, candidate);
1530c98411dcSBitterblue Smith dev_dbg(dev, "%s: e94=%x e9c=%x ea4=%x eac=%x eb4=%x ebc=%x ec4=%x ecc=%c\n",
1531c98411dcSBitterblue Smith __func__, reg_e94, reg_e9c, reg_ea4, reg_eac,
1532c98411dcSBitterblue Smith reg_eb4, reg_ebc, reg_ec4, reg_ecc);
1533c98411dcSBitterblue Smith
1534c98411dcSBitterblue Smith path_a_ok = true;
1535c98411dcSBitterblue Smith path_b_ok = true;
1536c98411dcSBitterblue Smith }
1537c98411dcSBitterblue Smith
1538c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_IQK_TONE_A, 0x3ff00000, 0x100);
1539c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_NP_ANTA, 0x3ff, 0);
1540c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TX_IQK_TONE_B, 0x3ff00000, 0x100);
1541c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_TAP_UPD_97F, 0x3ff, 0);
1542c98411dcSBitterblue Smith
1543c98411dcSBitterblue Smith if (candidate >= 0) {
1544c98411dcSBitterblue Smith if (reg_e94)
1545c98411dcSBitterblue Smith rtl8xxxu_fill_iqk_matrix_a(priv, path_a_ok, result,
1546c98411dcSBitterblue Smith candidate, (reg_ea4 == 0));
1547c98411dcSBitterblue Smith
1548c98411dcSBitterblue Smith if (reg_eb4)
1549c98411dcSBitterblue Smith rtl8xxxu_fill_iqk_matrix_b(priv, path_b_ok, result,
1550c98411dcSBitterblue Smith candidate, (reg_ec4 == 0));
1551c98411dcSBitterblue Smith }
1552c98411dcSBitterblue Smith
1553103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_GAIN_CCA, path_a_0xdf);
1554c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_GAIN_P1, path_a_0x35);
1555103d6e9dSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_GAIN_CCA, path_b_0xdf);
1556c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_B, RF6052_REG_GAIN_P1, path_b_0x35);
1557c98411dcSBitterblue Smith
1558c98411dcSBitterblue Smith if (rfe == 7 || rfe == 8 || rfe == 9 || rfe == 12) {
1559c98411dcSBitterblue Smith rtl8xxxu_write32_set(priv, REG_SW_GPIO_SHARE_CTRL_1, 0x70000);
1560c98411dcSBitterblue Smith rtl8xxxu_write32_clear(priv, REG_LEDCFG0, 0x6c00000);
1561c98411dcSBitterblue Smith rtl8xxxu_write32_set(priv, REG_PAD_CTRL1, BIT(29) | BIT(28));
1562c98411dcSBitterblue Smith rtl8xxxu_write32_clear(priv, REG_SW_GPIO_SHARE_CTRL_0,
1563c98411dcSBitterblue Smith 0x600000 | BIT(4));
1564c98411dcSBitterblue Smith
1565c98411dcSBitterblue Smith /*
1566c98411dcSBitterblue Smith * Originally:
1567c98411dcSBitterblue Smith * odm_set_bb_reg(dm, R_0x944, BIT(11) | 0x1F, 0x3F);
1568c98411dcSBitterblue Smith *
1569c98411dcSBitterblue Smith * It clears bit 11 and sets bits 0..4. The mask doesn't cover
1570c98411dcSBitterblue Smith * bit 5 so it's not modified. Is that what it's supposed to
1571c98411dcSBitterblue Smith * accomplish?
1572c98411dcSBitterblue Smith */
1573c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_RFE_BUFFER);
1574c98411dcSBitterblue Smith val32 &= ~BIT(11);
1575c98411dcSBitterblue Smith val32 |= 0x1f;
1576c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RFE_BUFFER, val32);
1577c98411dcSBitterblue Smith
1578c98411dcSBitterblue Smith if (rfe == 7) {
1579c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANTA_SRC,
1580c98411dcSBitterblue Smith 0xfffff, 0x23200);
1581c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANT_SRC2,
1582c98411dcSBitterblue Smith 0xfffff, 0x23200);
1583c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANT_SRC1,
1584c98411dcSBitterblue Smith 0xf000, 0x3);
1585c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANT_SRC3,
1586c98411dcSBitterblue Smith 0xf000, 0x3);
1587c98411dcSBitterblue Smith } else {
1588c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANTA_SRC,
1589c98411dcSBitterblue Smith 0xfffff, 0x22200);
1590c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANT_SRC2,
1591c98411dcSBitterblue Smith 0xfffff, 0x22200);
1592c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANT_SRC1,
1593c98411dcSBitterblue Smith 0xf000, 0x2);
1594c98411dcSBitterblue Smith rtl8xxxu_write32_mask(priv, REG_RFE_CTRL_ANT_SRC3,
1595c98411dcSBitterblue Smith 0xf000, 0x2);
1596c98411dcSBitterblue Smith }
1597c98411dcSBitterblue Smith
1598c98411dcSBitterblue Smith rtl8xxxu_write32_clear(priv, REG_RFE_OPT62, BIT(2));
1599c98411dcSBitterblue Smith
1600c98411dcSBitterblue Smith if (rfe == 7)
1601c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RFE_OPT, 0x03000003);
1602c98411dcSBitterblue Smith
1603c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_RFE_PATH_SELECT, rfe_path_select);
1604c98411dcSBitterblue Smith }
1605c98411dcSBitterblue Smith }
1606c98411dcSBitterblue Smith
rtl8192fu_disabled_to_emu(struct rtl8xxxu_priv * priv)1607c98411dcSBitterblue Smith static void rtl8192fu_disabled_to_emu(struct rtl8xxxu_priv *priv)
1608c98411dcSBitterblue Smith {
1609c98411dcSBitterblue Smith rtl8xxxu_write16_clear(priv, REG_APS_FSMCO,
1610c98411dcSBitterblue Smith APS_FSMCO_HW_POWERDOWN | APS_FSMCO_HW_SUSPEND);
1611c98411dcSBitterblue Smith
1612c98411dcSBitterblue Smith rtl8xxxu_write32_clear(priv, REG_GPIO_INTM, BIT(16));
1613c98411dcSBitterblue Smith
1614c98411dcSBitterblue Smith rtl8xxxu_write16_clear(priv, REG_APS_FSMCO,
1615c98411dcSBitterblue Smith APS_FSMCO_PCIE | APS_FSMCO_HW_SUSPEND);
1616c98411dcSBitterblue Smith }
1617c98411dcSBitterblue Smith
rtl8192fu_emu_to_active(struct rtl8xxxu_priv * priv)1618c98411dcSBitterblue Smith static int rtl8192fu_emu_to_active(struct rtl8xxxu_priv *priv)
1619c98411dcSBitterblue Smith {
1620c98411dcSBitterblue Smith u32 val32;
1621c98411dcSBitterblue Smith u16 val16;
1622c98411dcSBitterblue Smith int count;
1623c98411dcSBitterblue Smith
1624c98411dcSBitterblue Smith /* enable LDOA12 MACRO block for all interface */
1625c98411dcSBitterblue Smith rtl8xxxu_write8_set(priv, REG_LDOA15_CTRL, LDOA15_ENABLE);
1626c98411dcSBitterblue Smith
1627c98411dcSBitterblue Smith /* disable BT_GPS_SEL pins */
1628c98411dcSBitterblue Smith rtl8xxxu_write32_clear(priv, REG_PAD_CTRL1, BIT(28));
1629c98411dcSBitterblue Smith
1630c98411dcSBitterblue Smith mdelay(1);
1631c98411dcSBitterblue Smith
1632c98411dcSBitterblue Smith /* release analog Ips to digital */
1633c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_SYS_ISO_CTRL, SYS_ISO_ANALOG_IPS);
1634c98411dcSBitterblue Smith
1635c98411dcSBitterblue Smith val16 = APS_FSMCO_PCIE | APS_FSMCO_HW_SUSPEND | APS_FSMCO_SW_LPS;
1636c98411dcSBitterblue Smith rtl8xxxu_write16_clear(priv, REG_APS_FSMCO, val16);
1637c98411dcSBitterblue Smith
1638c98411dcSBitterblue Smith /* wait till 0x04[17] = 1 power ready */
1639c98411dcSBitterblue Smith for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
1640c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
1641c98411dcSBitterblue Smith if (val32 & BIT(17))
1642c98411dcSBitterblue Smith break;
1643c98411dcSBitterblue Smith
1644c98411dcSBitterblue Smith udelay(10);
1645c98411dcSBitterblue Smith }
1646c98411dcSBitterblue Smith
1647c98411dcSBitterblue Smith if (!count)
1648c98411dcSBitterblue Smith return -EBUSY;
1649c98411dcSBitterblue Smith
1650c98411dcSBitterblue Smith rtl8xxxu_write32_set(priv, REG_APS_FSMCO, APS_FSMCO_WLON_RESET);
1651c98411dcSBitterblue Smith
1652c98411dcSBitterblue Smith for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
1653c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
1654c98411dcSBitterblue Smith if ((val32 & (APS_FSMCO_MAC_ENABLE | APS_FSMCO_MAC_OFF)) == 0)
1655c98411dcSBitterblue Smith break;
1656c98411dcSBitterblue Smith
1657c98411dcSBitterblue Smith udelay(10);
1658c98411dcSBitterblue Smith }
1659c98411dcSBitterblue Smith
1660c98411dcSBitterblue Smith if (!count)
1661c98411dcSBitterblue Smith return -EBUSY;
1662c98411dcSBitterblue Smith
1663c98411dcSBitterblue Smith /* SWR OCP enable */
1664c98411dcSBitterblue Smith rtl8xxxu_write32_set(priv, REG_AFE_MISC, BIT(18));
1665c98411dcSBitterblue Smith
1666c98411dcSBitterblue Smith rtl8xxxu_write16_clear(priv, REG_APS_FSMCO, APS_FSMCO_HW_POWERDOWN);
1667c98411dcSBitterblue Smith
1668c98411dcSBitterblue Smith rtl8xxxu_write16_clear(priv, REG_APS_FSMCO,
1669c98411dcSBitterblue Smith APS_FSMCO_PCIE | APS_FSMCO_HW_SUSPEND);
1670c98411dcSBitterblue Smith
1671c98411dcSBitterblue Smith /* 0x7c[31]=1, LDO has max output capability */
1672c98411dcSBitterblue Smith rtl8xxxu_write32_set(priv, REG_LDO_SW_CTRL, BIT(31));
1673c98411dcSBitterblue Smith
1674c98411dcSBitterblue Smith rtl8xxxu_write16_set(priv, REG_APS_FSMCO, APS_FSMCO_MAC_ENABLE);
1675c98411dcSBitterblue Smith
1676c98411dcSBitterblue Smith for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
1677c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
1678c98411dcSBitterblue Smith if ((val32 & APS_FSMCO_MAC_ENABLE) == 0)
1679c98411dcSBitterblue Smith break;
1680c98411dcSBitterblue Smith
1681c98411dcSBitterblue Smith udelay(10);
1682c98411dcSBitterblue Smith }
1683c98411dcSBitterblue Smith
1684c98411dcSBitterblue Smith if (!count)
1685c98411dcSBitterblue Smith return -EBUSY;
1686c98411dcSBitterblue Smith
1687c98411dcSBitterblue Smith /* Enable WL control XTAL setting */
1688c98411dcSBitterblue Smith rtl8xxxu_write8_set(priv, REG_AFE_MISC, AFE_MISC_WL_XTAL_CTRL);
1689c98411dcSBitterblue Smith
1690c98411dcSBitterblue Smith /* Enable falling edge triggering interrupt */
1691c98411dcSBitterblue Smith rtl8xxxu_write16_set(priv, REG_GPIO_INTM, GPIO_INTM_EDGE_TRIG_IRQ);
1692c98411dcSBitterblue Smith
1693c98411dcSBitterblue Smith /* Enable GPIO9 data mode */
1694c98411dcSBitterblue Smith rtl8xxxu_write16_clear(priv, REG_GPIO_IO_SEL_2, GPIO_IO_SEL_2_GPIO09_IRQ);
1695c98411dcSBitterblue Smith
1696c98411dcSBitterblue Smith /* Enable GPIO9 input mode */
1697c98411dcSBitterblue Smith rtl8xxxu_write16_clear(priv, REG_GPIO_IO_SEL_2, GPIO_IO_SEL_2_GPIO09_INPUT);
1698c98411dcSBitterblue Smith
1699c98411dcSBitterblue Smith /* Enable HSISR GPIO[C:0] interrupt */
1700c98411dcSBitterblue Smith rtl8xxxu_write8_set(priv, REG_HSIMR, BIT(0));
1701c98411dcSBitterblue Smith
1702c98411dcSBitterblue Smith /* RF HW ON/OFF Enable */
1703c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_MULTI_FUNC_CTRL, MULTI_WIFI_HW_ROF_EN);
1704c98411dcSBitterblue Smith
1705c98411dcSBitterblue Smith /* Register Lock Disable */
1706c98411dcSBitterblue Smith rtl8xxxu_write8_set(priv, REG_RSV_CTRL, BIT(7));
1707c98411dcSBitterblue Smith
1708c98411dcSBitterblue Smith /* For GPIO9 internal pull high setting */
1709c98411dcSBitterblue Smith rtl8xxxu_write16_set(priv, REG_MULTI_FUNC_CTRL, BIT(14));
1710c98411dcSBitterblue Smith
1711c98411dcSBitterblue Smith /* reset RF path S1 */
1712c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_RF_CTRL, 0);
1713c98411dcSBitterblue Smith
1714c98411dcSBitterblue Smith /* reset RF path S0 */
1715c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_AFE_CTRL4 + 3, 0);
1716c98411dcSBitterblue Smith
1717c98411dcSBitterblue Smith /* enable RF path S1 */
1718c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_RF_CTRL, RF_SDMRSTB | RF_RSTB | RF_ENABLE);
1719c98411dcSBitterblue Smith
1720c98411dcSBitterblue Smith /* enable RF path S0 */
1721c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_AFE_CTRL4 + 3, RF_SDMRSTB | RF_RSTB | RF_ENABLE);
1722c98411dcSBitterblue Smith
1723c98411dcSBitterblue Smith /* AFE_Ctrl */
1724c98411dcSBitterblue Smith rtl8xxxu_write8_set(priv, REG_RSVD_1, BIT(5));
1725c98411dcSBitterblue Smith
1726c98411dcSBitterblue Smith /* AFE_Ctrl */
1727c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_RSVD_4, 0xcc);
1728c98411dcSBitterblue Smith
1729c98411dcSBitterblue Smith /* AFE_Ctrl 0x24[4:3]=00 for xtal gmn */
1730c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_AFE_XTAL_CTRL, BIT(4) | BIT(3));
1731c98411dcSBitterblue Smith
1732c98411dcSBitterblue Smith /* GPIO_A[31:0] Pull down software register */
1733c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_GPIO_A0, 0xffffffff);
1734c98411dcSBitterblue Smith
1735c98411dcSBitterblue Smith /* GPIO_B[7:0] Pull down software register */
1736c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_GPIO_B0, 0xff);
1737c98411dcSBitterblue Smith
1738c98411dcSBitterblue Smith /* Register Lock Enable */
1739c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_RSV_CTRL, BIT(7));
1740c98411dcSBitterblue Smith
1741c98411dcSBitterblue Smith return 0;
1742c98411dcSBitterblue Smith }
1743c98411dcSBitterblue Smith
rtl8192fu_active_to_emu(struct rtl8xxxu_priv * priv)1744c98411dcSBitterblue Smith static int rtl8192fu_active_to_emu(struct rtl8xxxu_priv *priv)
1745c98411dcSBitterblue Smith {
1746c98411dcSBitterblue Smith u32 val32;
1747c98411dcSBitterblue Smith int count;
1748c98411dcSBitterblue Smith
1749c98411dcSBitterblue Smith /* Reset BB, RF enter Power Down mode */
1750c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_SYS_FUNC, SYS_FUNC_BBRSTB);
1751c98411dcSBitterblue Smith
1752c98411dcSBitterblue Smith /* Enable rising edge triggering interrupt */
1753c98411dcSBitterblue Smith rtl8xxxu_write16_clear(priv, REG_GPIO_INTM, GPIO_INTM_EDGE_TRIG_IRQ);
1754c98411dcSBitterblue Smith
1755c98411dcSBitterblue Smith /* release WLON reset */
1756c98411dcSBitterblue Smith rtl8xxxu_write32_set(priv, REG_APS_FSMCO, APS_FSMCO_WLON_RESET);
1757c98411dcSBitterblue Smith
1758c98411dcSBitterblue Smith /* turn off MAC by HW state machine */
1759c98411dcSBitterblue Smith rtl8xxxu_write16_set(priv, REG_APS_FSMCO, APS_FSMCO_MAC_OFF);
1760c98411dcSBitterblue Smith
1761c98411dcSBitterblue Smith for (count = RTL8XXXU_MAX_REG_POLL; count; count--) {
1762c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_APS_FSMCO);
1763c98411dcSBitterblue Smith if ((val32 & APS_FSMCO_MAC_OFF) == 0)
1764c98411dcSBitterblue Smith break;
1765c98411dcSBitterblue Smith
1766c98411dcSBitterblue Smith udelay(10);
1767c98411dcSBitterblue Smith }
1768c98411dcSBitterblue Smith
1769c98411dcSBitterblue Smith if (!count)
1770c98411dcSBitterblue Smith return -EBUSY;
1771c98411dcSBitterblue Smith
1772c98411dcSBitterblue Smith /* analog Ips to digital, 1:isolation */
1773c98411dcSBitterblue Smith rtl8xxxu_write8_set(priv, REG_SYS_ISO_CTRL, SYS_ISO_ANALOG_IPS);
1774c98411dcSBitterblue Smith
1775c98411dcSBitterblue Smith /* disable LDOA12 MACRO block */
1776c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_LDOA15_CTRL, LDOA15_ENABLE);
1777c98411dcSBitterblue Smith
1778c98411dcSBitterblue Smith return 0;
1779c98411dcSBitterblue Smith }
1780c98411dcSBitterblue Smith
rtl8192fu_emu_to_disabled(struct rtl8xxxu_priv * priv)1781c98411dcSBitterblue Smith static int rtl8192fu_emu_to_disabled(struct rtl8xxxu_priv *priv)
1782c98411dcSBitterblue Smith {
1783c98411dcSBitterblue Smith u16 val16;
1784c98411dcSBitterblue Smith
1785c98411dcSBitterblue Smith /* SOP option to disable BG/MB */
1786c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_APS_FSMCO + 3, 0x20);
1787c98411dcSBitterblue Smith
1788c98411dcSBitterblue Smith /* 0x04[12:11] = 2b'01 enable WL suspend */
1789c98411dcSBitterblue Smith val16 = rtl8xxxu_read16(priv, REG_APS_FSMCO);
1790c98411dcSBitterblue Smith val16 &= ~APS_FSMCO_PCIE;
1791c98411dcSBitterblue Smith val16 |= APS_FSMCO_HW_SUSPEND;
1792c98411dcSBitterblue Smith rtl8xxxu_write16(priv, REG_APS_FSMCO, val16);
1793c98411dcSBitterblue Smith
1794c98411dcSBitterblue Smith /* enable GPIO9 as EXT WAKEUP */
1795c98411dcSBitterblue Smith rtl8xxxu_write32_set(priv, REG_GPIO_INTM, BIT(16));
1796c98411dcSBitterblue Smith
1797c98411dcSBitterblue Smith return 0;
1798c98411dcSBitterblue Smith }
1799c98411dcSBitterblue Smith
rtl8192fu_active_to_lps(struct rtl8xxxu_priv * priv)1800c98411dcSBitterblue Smith static int rtl8192fu_active_to_lps(struct rtl8xxxu_priv *priv)
1801c98411dcSBitterblue Smith {
1802c98411dcSBitterblue Smith struct device *dev = &priv->udev->dev;
1803c98411dcSBitterblue Smith u16 val16;
1804c98411dcSBitterblue Smith u32 val32;
1805c98411dcSBitterblue Smith int retry;
1806c98411dcSBitterblue Smith
1807c98411dcSBitterblue Smith /* Tx Pause */
1808c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_TXPAUSE, 0xff);
1809c98411dcSBitterblue Smith
1810c98411dcSBitterblue Smith retry = 100;
1811c98411dcSBitterblue Smith
1812c98411dcSBitterblue Smith /* Poll 32 bit wide REG_SCH_TX_CMD for 0 to ensure no TX is pending. */
1813c98411dcSBitterblue Smith do {
1814c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_SCH_TX_CMD);
1815c98411dcSBitterblue Smith if (!val32)
1816c98411dcSBitterblue Smith break;
1817c98411dcSBitterblue Smith
1818c98411dcSBitterblue Smith udelay(10);
1819c98411dcSBitterblue Smith } while (retry--);
1820c98411dcSBitterblue Smith
1821c98411dcSBitterblue Smith if (!retry) {
1822c98411dcSBitterblue Smith dev_warn(dev, "%s: Failed to flush TX queue\n", __func__);
1823c98411dcSBitterblue Smith return -EBUSY;
1824c98411dcSBitterblue Smith }
1825c98411dcSBitterblue Smith
1826c98411dcSBitterblue Smith /* Disable CCK and OFDM, clock gated */
1827c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_SYS_FUNC, SYS_FUNC_BBRSTB);
1828c98411dcSBitterblue Smith
1829c98411dcSBitterblue Smith udelay(2);
1830c98411dcSBitterblue Smith
1831c98411dcSBitterblue Smith /* Whole BB is reset */
1832c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_SYS_FUNC, SYS_FUNC_BB_GLB_RSTN);
1833c98411dcSBitterblue Smith
1834c98411dcSBitterblue Smith /* Reset MAC TRX */
1835c98411dcSBitterblue Smith val16 = rtl8xxxu_read16(priv, REG_CR);
1836c98411dcSBitterblue Smith val16 &= 0xff00;
1837c98411dcSBitterblue Smith val16 |= CR_HCI_RXDMA_ENABLE | CR_HCI_TXDMA_ENABLE;
1838c98411dcSBitterblue Smith val16 &= ~CR_SECURITY_ENABLE;
1839c98411dcSBitterblue Smith rtl8xxxu_write16(priv, REG_CR, val16);
1840c98411dcSBitterblue Smith
1841c98411dcSBitterblue Smith /* Respond TxOK to scheduler */
1842c98411dcSBitterblue Smith rtl8xxxu_write8_set(priv, REG_DUAL_TSF_RST, DUAL_TSF_TX_OK);
1843c98411dcSBitterblue Smith
1844c98411dcSBitterblue Smith return 0;
1845c98411dcSBitterblue Smith }
1846c98411dcSBitterblue Smith
rtl8192fu_power_on(struct rtl8xxxu_priv * priv)1847c98411dcSBitterblue Smith static int rtl8192fu_power_on(struct rtl8xxxu_priv *priv)
1848c98411dcSBitterblue Smith {
1849c98411dcSBitterblue Smith u16 val16;
1850c98411dcSBitterblue Smith int ret;
1851c98411dcSBitterblue Smith
1852c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_USB_ACCESS_TIMEOUT, 0x80);
1853c98411dcSBitterblue Smith
1854c98411dcSBitterblue Smith rtl8192fu_disabled_to_emu(priv);
1855c98411dcSBitterblue Smith
1856c98411dcSBitterblue Smith ret = rtl8192fu_emu_to_active(priv);
1857c98411dcSBitterblue Smith if (ret)
1858c98411dcSBitterblue Smith return ret;
1859c98411dcSBitterblue Smith
1860c98411dcSBitterblue Smith rtl8xxxu_write16(priv, REG_CR, 0);
1861c98411dcSBitterblue Smith
1862c98411dcSBitterblue Smith val16 = rtl8xxxu_read16(priv, REG_CR);
1863c98411dcSBitterblue Smith
1864c98411dcSBitterblue Smith val16 |= CR_HCI_TXDMA_ENABLE | CR_HCI_RXDMA_ENABLE |
1865c98411dcSBitterblue Smith CR_TXDMA_ENABLE | CR_RXDMA_ENABLE |
1866c98411dcSBitterblue Smith CR_PROTOCOL_ENABLE | CR_SCHEDULE_ENABLE |
1867c98411dcSBitterblue Smith CR_SECURITY_ENABLE | CR_CALTIMER_ENABLE;
1868c98411dcSBitterblue Smith rtl8xxxu_write16(priv, REG_CR, val16);
1869c98411dcSBitterblue Smith
1870c98411dcSBitterblue Smith return 0;
1871c98411dcSBitterblue Smith }
1872c98411dcSBitterblue Smith
rtl8192fu_power_off(struct rtl8xxxu_priv * priv)1873c98411dcSBitterblue Smith static void rtl8192fu_power_off(struct rtl8xxxu_priv *priv)
1874c98411dcSBitterblue Smith {
1875c98411dcSBitterblue Smith rtl8xxxu_flush_fifo(priv);
1876c98411dcSBitterblue Smith
1877c98411dcSBitterblue Smith /* Stop Tx Report Timer. 0x4EC[Bit1]=b'0 */
1878c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_TX_REPORT_CTRL,
1879c98411dcSBitterblue Smith TX_REPORT_CTRL_TIMER_ENABLE);
1880c98411dcSBitterblue Smith
1881c98411dcSBitterblue Smith /* stop rx */
1882c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_CR, 0x00);
1883c98411dcSBitterblue Smith
1884c98411dcSBitterblue Smith rtl8192fu_active_to_lps(priv);
1885c98411dcSBitterblue Smith
1886c98411dcSBitterblue Smith /* Reset Firmware if running in RAM */
1887c98411dcSBitterblue Smith if (rtl8xxxu_read8(priv, REG_MCU_FW_DL) & MCU_FW_RAM_SEL)
1888c98411dcSBitterblue Smith rtl8xxxu_firmware_self_reset(priv);
1889c98411dcSBitterblue Smith
1890c98411dcSBitterblue Smith /* Reset MCU */
1891c98411dcSBitterblue Smith rtl8xxxu_write16_clear(priv, REG_SYS_FUNC, SYS_FUNC_CPU_ENABLE);
1892c98411dcSBitterblue Smith
1893c98411dcSBitterblue Smith /* Reset MCU ready status */
1894c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_MCU_FW_DL, 0x00);
1895c98411dcSBitterblue Smith
1896c98411dcSBitterblue Smith rtl8192fu_active_to_emu(priv);
1897c98411dcSBitterblue Smith rtl8192fu_emu_to_disabled(priv);
1898c98411dcSBitterblue Smith }
1899c98411dcSBitterblue Smith
rtl8192f_reset_8051(struct rtl8xxxu_priv * priv)1900c98411dcSBitterblue Smith static void rtl8192f_reset_8051(struct rtl8xxxu_priv *priv)
1901c98411dcSBitterblue Smith {
1902c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_RSV_CTRL, BIT(1));
1903c98411dcSBitterblue Smith
1904c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_RSV_CTRL + 1, BIT(0));
1905c98411dcSBitterblue Smith
1906c98411dcSBitterblue Smith rtl8xxxu_write16_clear(priv, REG_SYS_FUNC, SYS_FUNC_CPU_ENABLE);
1907c98411dcSBitterblue Smith
1908c98411dcSBitterblue Smith rtl8xxxu_write8_clear(priv, REG_RSV_CTRL, BIT(1));
1909c98411dcSBitterblue Smith
1910c98411dcSBitterblue Smith rtl8xxxu_write8_set(priv, REG_RSV_CTRL + 1, BIT(0));
1911c98411dcSBitterblue Smith
1912c98411dcSBitterblue Smith rtl8xxxu_write16_set(priv, REG_SYS_FUNC, SYS_FUNC_CPU_ENABLE);
1913c98411dcSBitterblue Smith }
1914c98411dcSBitterblue Smith
rtl8192f_enable_rf(struct rtl8xxxu_priv * priv)1915c98411dcSBitterblue Smith static void rtl8192f_enable_rf(struct rtl8xxxu_priv *priv)
1916c98411dcSBitterblue Smith {
1917c98411dcSBitterblue Smith u32 val32;
1918c98411dcSBitterblue Smith
1919c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_RF_CTRL, RF_ENABLE | RF_RSTB | RF_SDMRSTB);
1920c98411dcSBitterblue Smith
1921c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_OFDM0_TRX_PATH_ENABLE);
1922c98411dcSBitterblue Smith val32 &= ~(OFDM_RF_PATH_RX_MASK | OFDM_RF_PATH_TX_MASK);
1923c98411dcSBitterblue Smith val32 |= OFDM_RF_PATH_RX_A | OFDM_RF_PATH_RX_B |
1924c98411dcSBitterblue Smith OFDM_RF_PATH_TX_A | OFDM_RF_PATH_TX_B;
1925c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, val32);
1926c98411dcSBitterblue Smith
1927c98411dcSBitterblue Smith rtl8xxxu_write8(priv, REG_TXPAUSE, 0x00);
1928c98411dcSBitterblue Smith }
1929c98411dcSBitterblue Smith
rtl8192f_disable_rf(struct rtl8xxxu_priv * priv)1930c98411dcSBitterblue Smith static void rtl8192f_disable_rf(struct rtl8xxxu_priv *priv)
1931c98411dcSBitterblue Smith {
1932c98411dcSBitterblue Smith u32 val32;
1933c98411dcSBitterblue Smith
1934c98411dcSBitterblue Smith val32 = rtl8xxxu_read32(priv, REG_OFDM0_TRX_PATH_ENABLE);
1935c98411dcSBitterblue Smith val32 &= ~OFDM_RF_PATH_TX_MASK;
1936c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_OFDM0_TRX_PATH_ENABLE, val32);
1937c98411dcSBitterblue Smith
1938c98411dcSBitterblue Smith /* Power down RF module */
1939c98411dcSBitterblue Smith rtl8xxxu_write_rfreg(priv, RF_A, RF6052_REG_AC, 0);
1940c98411dcSBitterblue Smith }
1941c98411dcSBitterblue Smith
rtl8192f_usb_quirks(struct rtl8xxxu_priv * priv)1942c98411dcSBitterblue Smith static void rtl8192f_usb_quirks(struct rtl8xxxu_priv *priv)
1943c98411dcSBitterblue Smith {
1944c98411dcSBitterblue Smith u16 val16;
1945c98411dcSBitterblue Smith
1946c98411dcSBitterblue Smith rtl8xxxu_gen2_usb_quirks(priv);
1947c98411dcSBitterblue Smith
1948c98411dcSBitterblue Smith val16 = rtl8xxxu_read16(priv, REG_CR);
1949c98411dcSBitterblue Smith val16 |= (CR_MAC_TX_ENABLE | CR_MAC_RX_ENABLE);
1950c98411dcSBitterblue Smith rtl8xxxu_write16(priv, REG_CR, val16);
1951c98411dcSBitterblue Smith }
1952c98411dcSBitterblue Smith
1953c98411dcSBitterblue Smith #define XTAL1 GENMASK(6, 1)
1954c98411dcSBitterblue Smith #define XTAL0 GENMASK(30, 25)
1955c98411dcSBitterblue Smith
rtl8192f_set_crystal_cap(struct rtl8xxxu_priv * priv,u8 crystal_cap)1956c98411dcSBitterblue Smith static void rtl8192f_set_crystal_cap(struct rtl8xxxu_priv *priv, u8 crystal_cap)
1957c98411dcSBitterblue Smith {
1958c98411dcSBitterblue Smith struct rtl8xxxu_cfo_tracking *cfo = &priv->cfo_tracking;
1959c98411dcSBitterblue Smith u32 xtal1, xtal0;
1960c98411dcSBitterblue Smith
1961c98411dcSBitterblue Smith if (crystal_cap == cfo->crystal_cap)
1962c98411dcSBitterblue Smith return;
1963c98411dcSBitterblue Smith
1964c98411dcSBitterblue Smith xtal1 = rtl8xxxu_read32(priv, REG_AFE_PLL_CTRL);
1965c98411dcSBitterblue Smith xtal0 = rtl8xxxu_read32(priv, REG_AFE_XTAL_CTRL);
1966c98411dcSBitterblue Smith
1967c98411dcSBitterblue Smith dev_dbg(&priv->udev->dev,
1968c98411dcSBitterblue Smith "%s: Adjusting crystal cap from 0x%x (actually 0x%x 0x%x) to 0x%x\n",
1969c98411dcSBitterblue Smith __func__,
1970c98411dcSBitterblue Smith cfo->crystal_cap,
1971c98411dcSBitterblue Smith u32_get_bits(xtal1, XTAL1),
1972c98411dcSBitterblue Smith u32_get_bits(xtal0, XTAL0),
1973c98411dcSBitterblue Smith crystal_cap);
1974c98411dcSBitterblue Smith
1975c98411dcSBitterblue Smith u32p_replace_bits(&xtal1, crystal_cap, XTAL1);
1976c98411dcSBitterblue Smith u32p_replace_bits(&xtal0, crystal_cap, XTAL0);
1977c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_AFE_PLL_CTRL, xtal1);
1978c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_AFE_XTAL_CTRL, xtal0);
1979c98411dcSBitterblue Smith
1980c98411dcSBitterblue Smith cfo->crystal_cap = crystal_cap;
1981c98411dcSBitterblue Smith }
1982c98411dcSBitterblue Smith
rtl8192f_cck_rssi(struct rtl8xxxu_priv * priv,struct rtl8723au_phy_stats * phy_stats)1983c98411dcSBitterblue Smith static s8 rtl8192f_cck_rssi(struct rtl8xxxu_priv *priv, struct rtl8723au_phy_stats *phy_stats)
1984c98411dcSBitterblue Smith {
1985c98411dcSBitterblue Smith struct jaguar2_phy_stats_type0 *phy_stats0 = (struct jaguar2_phy_stats_type0 *)phy_stats;
1986c98411dcSBitterblue Smith u8 lna_idx = (phy_stats0->lna_h << 3) | phy_stats0->lna_l;
1987c98411dcSBitterblue Smith u8 vga_idx = phy_stats0->vga;
1988c98411dcSBitterblue Smith s8 rx_pwr_all;
1989c98411dcSBitterblue Smith
1990c98411dcSBitterblue Smith switch (lna_idx) {
1991c98411dcSBitterblue Smith case 7:
1992c98411dcSBitterblue Smith rx_pwr_all = -44 - (2 * vga_idx);
1993c98411dcSBitterblue Smith break;
1994c98411dcSBitterblue Smith case 5:
1995c98411dcSBitterblue Smith rx_pwr_all = -28 - (2 * vga_idx);
1996c98411dcSBitterblue Smith break;
1997c98411dcSBitterblue Smith case 3:
1998c98411dcSBitterblue Smith rx_pwr_all = -10 - (2 * vga_idx);
1999c98411dcSBitterblue Smith break;
2000c98411dcSBitterblue Smith case 0:
2001c98411dcSBitterblue Smith rx_pwr_all = 14 - (2 * vga_idx);
2002c98411dcSBitterblue Smith break;
2003c98411dcSBitterblue Smith default:
2004c98411dcSBitterblue Smith rx_pwr_all = 0;
2005c98411dcSBitterblue Smith break;
2006c98411dcSBitterblue Smith }
2007c98411dcSBitterblue Smith
2008c98411dcSBitterblue Smith return rx_pwr_all;
2009c98411dcSBitterblue Smith }
2010c98411dcSBitterblue Smith
rtl8192fu_led_brightness_set(struct led_classdev * led_cdev,enum led_brightness brightness)2011c98411dcSBitterblue Smith static int rtl8192fu_led_brightness_set(struct led_classdev *led_cdev,
2012c98411dcSBitterblue Smith enum led_brightness brightness)
2013c98411dcSBitterblue Smith {
2014c98411dcSBitterblue Smith struct rtl8xxxu_priv *priv = container_of(led_cdev,
2015c98411dcSBitterblue Smith struct rtl8xxxu_priv,
2016c98411dcSBitterblue Smith led_cdev);
2017c98411dcSBitterblue Smith u16 ledcfg;
2018c98411dcSBitterblue Smith
2019c98411dcSBitterblue Smith /* Values obtained by observing the USB traffic from the Windows driver. */
2020c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_SW_GPIO_SHARE_CTRL_0, 0x20080);
2021c98411dcSBitterblue Smith rtl8xxxu_write32(priv, REG_SW_GPIO_SHARE_CTRL_1, 0x1b0000);
2022c98411dcSBitterblue Smith
2023c98411dcSBitterblue Smith ledcfg = rtl8xxxu_read16(priv, REG_LEDCFG0);
2024c98411dcSBitterblue Smith
2025c98411dcSBitterblue Smith if (brightness == LED_OFF) {
2026c98411dcSBitterblue Smith /* Value obtained like above. */
2027c98411dcSBitterblue Smith ledcfg = BIT(1) | BIT(7);
2028c98411dcSBitterblue Smith } else if (brightness == LED_ON) {
2029c98411dcSBitterblue Smith /* Value obtained like above. */
2030c98411dcSBitterblue Smith ledcfg = BIT(1) | BIT(7) | BIT(11);
2031c98411dcSBitterblue Smith } else if (brightness == RTL8XXXU_HW_LED_CONTROL) {
2032c98411dcSBitterblue Smith /* Value obtained by brute force. */
2033c98411dcSBitterblue Smith ledcfg = BIT(8) | BIT(9);
2034c98411dcSBitterblue Smith }
2035c98411dcSBitterblue Smith
2036c98411dcSBitterblue Smith rtl8xxxu_write16(priv, REG_LEDCFG0, ledcfg);
2037c98411dcSBitterblue Smith
2038c98411dcSBitterblue Smith return 0;
2039c98411dcSBitterblue Smith }
2040c98411dcSBitterblue Smith
2041c98411dcSBitterblue Smith struct rtl8xxxu_fileops rtl8192fu_fops = {
2042c98411dcSBitterblue Smith .identify_chip = rtl8192fu_identify_chip,
2043c98411dcSBitterblue Smith .parse_efuse = rtl8192fu_parse_efuse,
2044c98411dcSBitterblue Smith .load_firmware = rtl8192fu_load_firmware,
2045c98411dcSBitterblue Smith .power_on = rtl8192fu_power_on,
2046c98411dcSBitterblue Smith .power_off = rtl8192fu_power_off,
2047c98411dcSBitterblue Smith .read_efuse = rtl8xxxu_read_efuse,
2048c98411dcSBitterblue Smith .reset_8051 = rtl8192f_reset_8051,
2049c98411dcSBitterblue Smith .llt_init = rtl8xxxu_auto_llt_table,
2050c98411dcSBitterblue Smith .init_phy_bb = rtl8192fu_init_phy_bb,
2051c98411dcSBitterblue Smith .init_phy_rf = rtl8192fu_init_phy_rf,
2052c98411dcSBitterblue Smith .phy_lc_calibrate = rtl8192f_phy_lc_calibrate,
2053c98411dcSBitterblue Smith .phy_iq_calibrate = rtl8192fu_phy_iq_calibrate,
2054c98411dcSBitterblue Smith .config_channel = rtl8192fu_config_channel,
2055c98411dcSBitterblue Smith .parse_rx_desc = rtl8xxxu_parse_rxdesc24,
2056c98411dcSBitterblue Smith .parse_phystats = jaguar2_rx_parse_phystats,
2057c98411dcSBitterblue Smith .init_aggregation = rtl8192fu_init_aggregation,
2058c98411dcSBitterblue Smith .init_burst = rtl8xxxu_init_burst,
2059c98411dcSBitterblue Smith .enable_rf = rtl8192f_enable_rf,
2060c98411dcSBitterblue Smith .disable_rf = rtl8192f_disable_rf,
2061c98411dcSBitterblue Smith .usb_quirks = rtl8192f_usb_quirks,
2062c98411dcSBitterblue Smith .set_tx_power = rtl8192f_set_tx_power,
2063c98411dcSBitterblue Smith .update_rate_mask = rtl8xxxu_gen2_update_rate_mask,
2064c98411dcSBitterblue Smith .report_connect = rtl8xxxu_gen2_report_connect,
2065c98411dcSBitterblue Smith .report_rssi = rtl8xxxu_gen2_report_rssi,
2066c98411dcSBitterblue Smith .fill_txdesc = rtl8xxxu_fill_txdesc_v2,
2067c98411dcSBitterblue Smith .set_crystal_cap = rtl8192f_set_crystal_cap,
2068c98411dcSBitterblue Smith .cck_rssi = rtl8192f_cck_rssi,
2069c98411dcSBitterblue Smith .led_classdev_brightness_set = rtl8192fu_led_brightness_set,
2070c98411dcSBitterblue Smith .writeN_block_size = 254,
2071c98411dcSBitterblue Smith .rx_desc_size = sizeof(struct rtl8xxxu_rxdesc24),
2072c98411dcSBitterblue Smith .tx_desc_size = sizeof(struct rtl8xxxu_txdesc40),
2073c98411dcSBitterblue Smith .has_tx_report = 1,
2074c98411dcSBitterblue Smith .gen2_thermal_meter = 1,
2075c98411dcSBitterblue Smith .needs_full_init = 1,
2076c98411dcSBitterblue Smith .init_reg_rxfltmap = 1,
2077c98411dcSBitterblue Smith .init_reg_pkt_life_time = 1,
2078c98411dcSBitterblue Smith .init_reg_hmtfr = 1,
2079c98411dcSBitterblue Smith .ampdu_max_time = 0x5e,
2080c98411dcSBitterblue Smith .ustime_tsf_edca = 0x50,
2081c98411dcSBitterblue Smith .max_aggr_num = 0x1f1f,
2082*efbc7e79SBitterblue Smith .supports_ap = 1,
2083*efbc7e79SBitterblue Smith .max_macid_num = 128,
2084c98411dcSBitterblue Smith .trxff_boundary = 0x3f3f,
2085c98411dcSBitterblue Smith .pbp_rx = PBP_PAGE_SIZE_256,
2086c98411dcSBitterblue Smith .pbp_tx = PBP_PAGE_SIZE_256,
2087c98411dcSBitterblue Smith .mactable = rtl8192f_mac_init_table,
2088c98411dcSBitterblue Smith .total_page_num = TX_TOTAL_PAGE_NUM_8192F,
2089c98411dcSBitterblue Smith .page_num_hi = TX_PAGE_NUM_HI_PQ_8192F,
2090c98411dcSBitterblue Smith .page_num_lo = TX_PAGE_NUM_LO_PQ_8192F,
2091c98411dcSBitterblue Smith .page_num_norm = TX_PAGE_NUM_NORM_PQ_8192F,
2092c98411dcSBitterblue Smith };
2093