1 /*
2  * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
3  * All rights reserved.
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation; either version 2 of the License, or
8  * (at your option) any later version.
9  *
10  * This program is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  * GNU General Public License for more details.
14  *
15  * You should have received a copy of the GNU General Public License along
16  * with this program; if not, write to the Free Software Foundation, Inc.,
17  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18  *
19  *
20  * File: rf.c
21  *
22  * Purpose: rf function code
23  *
24  * Author: Jerry Chen
25  *
26  * Date: Feb. 19, 2004
27  *
28  * Functions:
29  *      IFRFbWriteEmbedded      - Embedded write RF register via MAC
30  *
31  * Revision History:
32  *	RobertYu 2005
33  *	chester 2008
34  *
35  */
36 
37 #include "mac.h"
38 #include "srom.h"
39 #include "rf.h"
40 #include "baseband.h"
41 
42 #define BY_AL2230_REG_LEN     23 //24bit
43 #define CB_AL2230_INIT_SEQ    15
44 #define SWITCH_CHANNEL_DELAY_AL2230 200 //us
45 #define AL2230_PWR_IDX_LEN    64
46 
47 #define BY_AL7230_REG_LEN     23 //24bit
48 #define CB_AL7230_INIT_SEQ    16
49 #define SWITCH_CHANNEL_DELAY_AL7230 200 //us
50 #define AL7230_PWR_IDX_LEN    64
51 
52 static const unsigned long dwAL2230InitTable[CB_AL2230_INIT_SEQ] = {
53 	0x03F79000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, //
54 	0x03333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, //
55 	0x01A00200+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, //
56 	0x00FFF300+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, //
57 	0x0005A400+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, //
58 	0x0F4DC500+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, //
59 	0x0805B600+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, //
60 	0x0146C700+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, //
61 	0x00068800+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, //
62 	0x0403B900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, //
63 	0x00DBBA00+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, //
64 	0x00099B00+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, //
65 	0x0BDFFC00+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
66 	0x00000D00+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
67 	0x00580F00+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW
68 };
69 
70 static const unsigned long dwAL2230ChannelTable0[CB_MAX_CHANNEL] = {
71 	0x03F79000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 1, Tf = 2412MHz
72 	0x03F79000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 2, Tf = 2417MHz
73 	0x03E79000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 3, Tf = 2422MHz
74 	0x03E79000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 4, Tf = 2427MHz
75 	0x03F7A000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 5, Tf = 2432MHz
76 	0x03F7A000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 6, Tf = 2437MHz
77 	0x03E7A000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 7, Tf = 2442MHz
78 	0x03E7A000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 8, Tf = 2447MHz
79 	0x03F7B000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 9, Tf = 2452MHz
80 	0x03F7B000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 10, Tf = 2457MHz
81 	0x03E7B000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 11, Tf = 2462MHz
82 	0x03E7B000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 12, Tf = 2467MHz
83 	0x03F7C000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 13, Tf = 2472MHz
84 	0x03E7C000+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW  // channel = 14, Tf = 2412M
85 };
86 
87 static const unsigned long dwAL2230ChannelTable1[CB_MAX_CHANNEL] = {
88 	0x03333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 1, Tf = 2412MHz
89 	0x0B333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 2, Tf = 2417MHz
90 	0x03333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 3, Tf = 2422MHz
91 	0x0B333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 4, Tf = 2427MHz
92 	0x03333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 5, Tf = 2432MHz
93 	0x0B333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 6, Tf = 2437MHz
94 	0x03333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 7, Tf = 2442MHz
95 	0x0B333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 8, Tf = 2447MHz
96 	0x03333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 9, Tf = 2452MHz
97 	0x0B333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 10, Tf = 2457MHz
98 	0x03333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 11, Tf = 2462MHz
99 	0x0B333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 12, Tf = 2467MHz
100 	0x03333100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 13, Tf = 2472MHz
101 	0x06666100+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW  // channel = 14, Tf = 2412M
102 };
103 
104 static unsigned long dwAL2230PowerTable[AL2230_PWR_IDX_LEN] = {
105 	0x04040900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
106 	0x04041900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
107 	0x04042900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
108 	0x04043900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
109 	0x04044900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
110 	0x04045900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
111 	0x04046900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
112 	0x04047900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
113 	0x04048900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
114 	0x04049900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
115 	0x0404A900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
116 	0x0404B900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
117 	0x0404C900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
118 	0x0404D900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
119 	0x0404E900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
120 	0x0404F900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
121 	0x04050900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
122 	0x04051900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
123 	0x04052900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
124 	0x04053900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
125 	0x04054900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
126 	0x04055900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
127 	0x04056900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
128 	0x04057900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
129 	0x04058900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
130 	0x04059900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
131 	0x0405A900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
132 	0x0405B900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
133 	0x0405C900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
134 	0x0405D900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
135 	0x0405E900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
136 	0x0405F900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
137 	0x04060900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
138 	0x04061900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
139 	0x04062900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
140 	0x04063900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
141 	0x04064900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
142 	0x04065900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
143 	0x04066900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
144 	0x04067900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
145 	0x04068900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
146 	0x04069900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
147 	0x0406A900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
148 	0x0406B900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
149 	0x0406C900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
150 	0x0406D900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
151 	0x0406E900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
152 	0x0406F900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
153 	0x04070900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
154 	0x04071900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
155 	0x04072900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
156 	0x04073900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
157 	0x04074900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
158 	0x04075900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
159 	0x04076900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
160 	0x04077900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
161 	0x04078900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
162 	0x04079900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
163 	0x0407A900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
164 	0x0407B900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
165 	0x0407C900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
166 	0x0407D900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
167 	0x0407E900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW,
168 	0x0407F900+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW
169 };
170 
171 // 40MHz reference frequency
172 // Need to Pull PLLON(PE3) low when writing channel registers through 3-wire.
173 static const unsigned long dwAL7230InitTable[CB_AL7230_INIT_SEQ] = {
174 	0x00379000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Channel1 // Need modify for 11a
175 	0x13333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Channel1 // Need modify for 11a
176 	0x841FF200+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Need modify for 11a: 451FE2
177 	0x3FDFA300+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Need modify for 11a: 5FDFA3
178 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // 11b/g    // Need modify for 11a
179 	// RoberYu:20050113, Rev0.47 Regsiter Setting Guide
180 	0x802B5500+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Need modify for 11a: 8D1B55
181 	0x56AF3600+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW,
182 	0xCE020700+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Need modify for 11a: 860207
183 	0x6EBC0800+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW,
184 	0x221BB900+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW,
185 	0xE0000A00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Need modify for 11a: E0600A
186 	0x08031B00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // init 0x080B1B00 => 0x080F1B00 for 3 wire control TxGain(D10)
187 	// RoberYu:20050113, Rev0.47 Regsiter Setting Guide
188 	0x000A3C00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Need modify for 11a: 00143C
189 	0xFFFFFD00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW,
190 	0x00000E00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW,
191 	0x1ABA8F00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW  // Need modify for 11a: 12BACF
192 };
193 
194 static const unsigned long dwAL7230InitTableAMode[CB_AL7230_INIT_SEQ] = {
195 	0x0FF52000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Channel184 // Need modify for 11b/g
196 	0x00000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Channel184 // Need modify for 11b/g
197 	0x451FE200+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Need modify for 11b/g
198 	0x5FDFA300+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Need modify for 11b/g
199 	0x67F78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // 11a    // Need modify for 11b/g
200 	0x853F5500+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Need modify for 11b/g, RoberYu:20050113
201 	0x56AF3600+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW,
202 	0xCE020700+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Need modify for 11b/g
203 	0x6EBC0800+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW,
204 	0x221BB900+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW,
205 	0xE0600A00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Need modify for 11b/g
206 	0x08031B00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // init 0x080B1B00 => 0x080F1B00 for 3 wire control TxGain(D10)
207 	0x00147C00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // Need modify for 11b/g
208 	0xFFFFFD00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW,
209 	0x00000E00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW,
210 	0x12BACF00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW  // Need modify for 11b/g
211 };
212 
213 static const unsigned long dwAL7230ChannelTable0[CB_MAX_CHANNEL] = {
214 	0x00379000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  1, Tf = 2412MHz
215 	0x00379000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  2, Tf = 2417MHz
216 	0x00379000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  3, Tf = 2422MHz
217 	0x00379000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  4, Tf = 2427MHz
218 	0x0037A000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  5, Tf = 2432MHz
219 	0x0037A000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  6, Tf = 2437MHz
220 	0x0037A000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  7, Tf = 2442MHz
221 	0x0037A000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  8, Tf = 2447MHz //RobertYu: 20050218, update for APNode 0.49
222 	0x0037B000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  9, Tf = 2452MHz //RobertYu: 20050218, update for APNode 0.49
223 	0x0037B000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 10, Tf = 2457MHz //RobertYu: 20050218, update for APNode 0.49
224 	0x0037B000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 11, Tf = 2462MHz //RobertYu: 20050218, update for APNode 0.49
225 	0x0037B000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 12, Tf = 2467MHz //RobertYu: 20050218, update for APNode 0.49
226 	0x0037C000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 13, Tf = 2472MHz //RobertYu: 20050218, update for APNode 0.49
227 	0x0037C000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 14, Tf = 2484MHz
228 
229 	// 4.9G => Ch 183, 184, 185, 187, 188, 189, 192, 196  (Value:15 ~ 22)
230 	0x0FF52000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 183, Tf = 4915MHz (15)
231 	0x0FF52000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 184, Tf = 4920MHz (16)
232 	0x0FF52000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 185, Tf = 4925MHz (17)
233 	0x0FF52000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 187, Tf = 4935MHz (18)
234 	0x0FF52000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 188, Tf = 4940MHz (19)
235 	0x0FF52000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 189, Tf = 4945MHz (20)
236 	0x0FF53000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 192, Tf = 4960MHz (21)
237 	0x0FF53000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 196, Tf = 4980MHz (22)
238 
239 	// 5G => Ch 7, 8, 9, 11, 12, 16, 34, 36, 38, 40, 42, 44, 46, 48, 52, 56, 60, 64,
240 	// 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165  (Value 23 ~ 56)
241 
242 	0x0FF54000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =   7, Tf = 5035MHz (23)
243 	0x0FF54000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =   8, Tf = 5040MHz (24)
244 	0x0FF54000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =   9, Tf = 5045MHz (25)
245 	0x0FF54000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  11, Tf = 5055MHz (26)
246 	0x0FF54000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  12, Tf = 5060MHz (27)
247 	0x0FF55000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  16, Tf = 5080MHz (28)
248 	0x0FF56000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  34, Tf = 5170MHz (29)
249 	0x0FF56000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  36, Tf = 5180MHz (30)
250 	0x0FF57000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  38, Tf = 5190MHz (31) //RobertYu: 20050218, update for APNode 0.49
251 	0x0FF57000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  40, Tf = 5200MHz (32)
252 	0x0FF57000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  42, Tf = 5210MHz (33)
253 	0x0FF57000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  44, Tf = 5220MHz (34)
254 	0x0FF57000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  46, Tf = 5230MHz (35)
255 	0x0FF57000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  48, Tf = 5240MHz (36)
256 	0x0FF58000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  52, Tf = 5260MHz (37)
257 	0x0FF58000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  56, Tf = 5280MHz (38)
258 	0x0FF58000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  60, Tf = 5300MHz (39)
259 	0x0FF59000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  64, Tf = 5320MHz (40)
260 
261 	0x0FF5C000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 100, Tf = 5500MHz (41)
262 	0x0FF5C000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 104, Tf = 5520MHz (42)
263 	0x0FF5C000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 108, Tf = 5540MHz (43)
264 	0x0FF5D000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 112, Tf = 5560MHz (44)
265 	0x0FF5D000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 116, Tf = 5580MHz (45)
266 	0x0FF5D000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 120, Tf = 5600MHz (46)
267 	0x0FF5E000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 124, Tf = 5620MHz (47)
268 	0x0FF5E000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 128, Tf = 5640MHz (48)
269 	0x0FF5E000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 132, Tf = 5660MHz (49)
270 	0x0FF5F000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 136, Tf = 5680MHz (50)
271 	0x0FF5F000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 140, Tf = 5700MHz (51)
272 	0x0FF60000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 149, Tf = 5745MHz (52)
273 	0x0FF60000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 153, Tf = 5765MHz (53)
274 	0x0FF60000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 157, Tf = 5785MHz (54)
275 	0x0FF61000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 161, Tf = 5805MHz (55)
276 	0x0FF61000+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW  // channel = 165, Tf = 5825MHz (56)
277 };
278 
279 static const unsigned long dwAL7230ChannelTable1[CB_MAX_CHANNEL] = {
280 	0x13333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  1, Tf = 2412MHz
281 	0x1B333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  2, Tf = 2417MHz
282 	0x03333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  3, Tf = 2422MHz
283 	0x0B333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  4, Tf = 2427MHz
284 	0x13333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  5, Tf = 2432MHz
285 	0x1B333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  6, Tf = 2437MHz
286 	0x03333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  7, Tf = 2442MHz
287 	0x0B333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  8, Tf = 2447MHz
288 	0x13333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  9, Tf = 2452MHz
289 	0x1B333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 10, Tf = 2457MHz
290 	0x03333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 11, Tf = 2462MHz
291 	0x0B333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 12, Tf = 2467MHz
292 	0x13333100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 13, Tf = 2472MHz
293 	0x06666100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 14, Tf = 2484MHz
294 
295 	// 4.9G => Ch 183, 184, 185, 187, 188, 189, 192, 196  (Value:15 ~ 22)
296 	0x1D555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 183, Tf = 4915MHz (15)
297 	0x00000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 184, Tf = 4920MHz (16)
298 	0x02AAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 185, Tf = 4925MHz (17)
299 	0x08000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 187, Tf = 4935MHz (18)
300 	0x0AAAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 188, Tf = 4940MHz (19)
301 	0x0D555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 189, Tf = 4945MHz (20)
302 	0x15555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 192, Tf = 4960MHz (21)
303 	0x00000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 196, Tf = 4980MHz (22)
304 
305 	// 5G => Ch 7, 8, 9, 11, 12, 16, 34, 36, 38, 40, 42, 44, 46, 48, 52, 56, 60, 64,
306 	// 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165  (Value 23 ~ 56)
307 	0x1D555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =   7, Tf = 5035MHz (23)
308 	0x00000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =   8, Tf = 5040MHz (24)
309 	0x02AAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =   9, Tf = 5045MHz (25)
310 	0x08000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  11, Tf = 5055MHz (26)
311 	0x0AAAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  12, Tf = 5060MHz (27)
312 	0x15555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  16, Tf = 5080MHz (28)
313 	0x05555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  34, Tf = 5170MHz (29)
314 	0x0AAAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  36, Tf = 5180MHz (30)
315 	0x10000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  38, Tf = 5190MHz (31)
316 	0x15555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  40, Tf = 5200MHz (32)
317 	0x1AAAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  42, Tf = 5210MHz (33)
318 	0x00000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  44, Tf = 5220MHz (34)
319 	0x05555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  46, Tf = 5230MHz (35)
320 	0x0AAAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  48, Tf = 5240MHz (36)
321 	0x15555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  52, Tf = 5260MHz (37)
322 	0x00000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  56, Tf = 5280MHz (38)
323 	0x0AAAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  60, Tf = 5300MHz (39)
324 	0x15555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  64, Tf = 5320MHz (40)
325 	0x15555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 100, Tf = 5500MHz (41)
326 	0x00000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 104, Tf = 5520MHz (42)
327 	0x0AAAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 108, Tf = 5540MHz (43)
328 	0x15555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 112, Tf = 5560MHz (44)
329 	0x00000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 116, Tf = 5580MHz (45)
330 	0x0AAAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 120, Tf = 5600MHz (46)
331 	0x15555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 124, Tf = 5620MHz (47)
332 	0x00000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 128, Tf = 5640MHz (48)
333 	0x0AAAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 132, Tf = 5660MHz (49)
334 	0x15555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 136, Tf = 5680MHz (50)
335 	0x00000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 140, Tf = 5700MHz (51)
336 	0x18000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 149, Tf = 5745MHz (52)
337 	0x02AAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 153, Tf = 5765MHz (53)
338 	0x0D555100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 157, Tf = 5785MHz (54)
339 	0x18000100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 161, Tf = 5805MHz (55)
340 	0x02AAA100+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW  // channel = 165, Tf = 5825MHz (56)
341 };
342 
343 static const unsigned long dwAL7230ChannelTable2[CB_MAX_CHANNEL] = {
344 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  1, Tf = 2412MHz
345 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  2, Tf = 2417MHz
346 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  3, Tf = 2422MHz
347 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  4, Tf = 2427MHz
348 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  5, Tf = 2432MHz
349 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  6, Tf = 2437MHz
350 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  7, Tf = 2442MHz
351 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  8, Tf = 2447MHz
352 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  9, Tf = 2452MHz
353 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 10, Tf = 2457MHz
354 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 11, Tf = 2462MHz
355 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 12, Tf = 2467MHz
356 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 13, Tf = 2472MHz
357 	0x7FD78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 14, Tf = 2484MHz
358 
359 	// 4.9G => Ch 183, 184, 185, 187, 188, 189, 192, 196  (Value:15 ~ 22)
360 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 183, Tf = 4915MHz (15)
361 	0x67D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 184, Tf = 4920MHz (16)
362 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 185, Tf = 4925MHz (17)
363 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 187, Tf = 4935MHz (18)
364 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 188, Tf = 4940MHz (19)
365 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 189, Tf = 4945MHz (20)
366 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 192, Tf = 4960MHz (21)
367 	0x67D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 196, Tf = 4980MHz (22)
368 
369 	// 5G => Ch 7, 8, 9, 11, 12, 16, 34, 36, 38, 40, 42, 44, 46, 48, 52, 56, 60, 64,
370 	// 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165  (Value 23 ~ 56)
371 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =   7, Tf = 5035MHz (23)
372 	0x67D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =   8, Tf = 5040MHz (24)
373 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =   9, Tf = 5045MHz (25)
374 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  11, Tf = 5055MHz (26)
375 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  12, Tf = 5060MHz (27)
376 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  16, Tf = 5080MHz (28)
377 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  34, Tf = 5170MHz (29)
378 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  36, Tf = 5180MHz (30)
379 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  38, Tf = 5190MHz (31)
380 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  40, Tf = 5200MHz (32)
381 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  42, Tf = 5210MHz (33)
382 	0x67D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  44, Tf = 5220MHz (34)
383 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  46, Tf = 5230MHz (35)
384 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  48, Tf = 5240MHz (36)
385 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  52, Tf = 5260MHz (37)
386 	0x67D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  56, Tf = 5280MHz (38)
387 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  60, Tf = 5300MHz (39)
388 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel =  64, Tf = 5320MHz (40)
389 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 100, Tf = 5500MHz (41)
390 	0x67D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 104, Tf = 5520MHz (42)
391 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 108, Tf = 5540MHz (43)
392 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 112, Tf = 5560MHz (44)
393 	0x67D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 116, Tf = 5580MHz (45)
394 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 120, Tf = 5600MHz (46)
395 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 124, Tf = 5620MHz (47)
396 	0x67D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 128, Tf = 5640MHz (48)
397 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 132, Tf = 5660MHz (49)
398 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 136, Tf = 5680MHz (50)
399 	0x67D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 140, Tf = 5700MHz (51)
400 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 149, Tf = 5745MHz (52)
401 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 153, Tf = 5765MHz (53)
402 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 157, Tf = 5785MHz (54)
403 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW, // channel = 161, Tf = 5805MHz (55)
404 	0x77D78400+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW  // channel = 165, Tf = 5825MHz (56)
405 };
406 
407 /*
408  * Description: AIROHA IFRF chip init function
409  *
410  * Parameters:
411  *  In:
412  *      dwIoBase    - I/O base address
413  *  Out:
414  *      none
415  *
416  * Return Value: true if succeeded; false if failed.
417  *
418  */
s_bAL7230Init(struct vnt_private * priv)419 static bool s_bAL7230Init(struct vnt_private *priv)
420 {
421 	void __iomem *dwIoBase = priv->PortOffset;
422 	int     ii;
423 	bool bResult;
424 
425 	bResult = true;
426 
427 	/* 3-wire control for normal mode */
428 	VNSvOutPortB(dwIoBase + MAC_REG_SOFTPWRCTL, 0);
429 
430 	MACvWordRegBitsOn(dwIoBase, MAC_REG_SOFTPWRCTL, (SOFTPWRCTL_SWPECTI  |
431 							 SOFTPWRCTL_TXPEINV));
432 	BBvPowerSaveModeOFF(priv); /* RobertYu:20050106, have DC value for Calibration */
433 
434 	for (ii = 0; ii < CB_AL7230_INIT_SEQ; ii++)
435 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTable[ii]);
436 
437 	/* PLL On */
438 	MACvWordRegBitsOn(dwIoBase, MAC_REG_SOFTPWRCTL, SOFTPWRCTL_SWPE3);
439 
440 	/* Calibration */
441 	MACvTimer0MicroSDelay(dwIoBase, 150);//150us
442 	/* TXDCOC:active, RCK:disable */
443 	bResult &= IFRFbWriteEmbedded(priv, (0x9ABA8F00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW));
444 	MACvTimer0MicroSDelay(dwIoBase, 30);//30us
445 	/* TXDCOC:disable, RCK:active */
446 	bResult &= IFRFbWriteEmbedded(priv, (0x3ABA8F00+(BY_AL7230_REG_LEN<<3)+IFREGCTL_REGW));
447 	MACvTimer0MicroSDelay(dwIoBase, 30);//30us
448 	/* TXDCOC:disable, RCK:disable */
449 	bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTable[CB_AL7230_INIT_SEQ-1]);
450 
451 	MACvWordRegBitsOn(dwIoBase, MAC_REG_SOFTPWRCTL, (SOFTPWRCTL_SWPE3    |
452 							 SOFTPWRCTL_SWPE2    |
453 							 SOFTPWRCTL_SWPECTI  |
454 							 SOFTPWRCTL_TXPEINV));
455 
456 	BBvPowerSaveModeON(priv); /* RobertYu:20050106 */
457 
458 	/* PE1: TX_ON, PE2: RX_ON, PE3: PLLON */
459 	/* 3-wire control for power saving mode */
460 	VNSvOutPortB(dwIoBase + MAC_REG_PSPWRSIG, (PSSIG_WPE3 | PSSIG_WPE2)); //1100 0000
461 
462 	return bResult;
463 }
464 
465 /* Need to Pull PLLON low when writing channel registers through
466  * 3-wire interface */
s_bAL7230SelectChannel(struct vnt_private * priv,unsigned char byChannel)467 static bool s_bAL7230SelectChannel(struct vnt_private *priv, unsigned char byChannel)
468 {
469 	void __iomem *dwIoBase = priv->PortOffset;
470 	bool bResult;
471 
472 	bResult = true;
473 
474 	/* PLLON Off */
475 	MACvWordRegBitsOff(dwIoBase, MAC_REG_SOFTPWRCTL, SOFTPWRCTL_SWPE3);
476 
477 	bResult &= IFRFbWriteEmbedded(priv, dwAL7230ChannelTable0[byChannel - 1]);
478 	bResult &= IFRFbWriteEmbedded(priv, dwAL7230ChannelTable1[byChannel - 1]);
479 	bResult &= IFRFbWriteEmbedded(priv, dwAL7230ChannelTable2[byChannel - 1]);
480 
481 	/* PLLOn On */
482 	MACvWordRegBitsOn(dwIoBase, MAC_REG_SOFTPWRCTL, SOFTPWRCTL_SWPE3);
483 
484 	/* Set Channel[7] = 0 to tell H/W channel is changing now. */
485 	VNSvOutPortB(dwIoBase + MAC_REG_CHANNEL, (byChannel & 0x7F));
486 	MACvTimer0MicroSDelay(dwIoBase, SWITCH_CHANNEL_DELAY_AL7230);
487 	/* Set Channel[7] = 1 to tell H/W channel change is done. */
488 	VNSvOutPortB(dwIoBase + MAC_REG_CHANNEL, (byChannel | 0x80));
489 
490 	return bResult;
491 }
492 
493 /*
494  * Description: Write to IF/RF, by embedded programming
495  *
496  * Parameters:
497  *  In:
498  *      dwIoBase    - I/O base address
499  *      dwData      - data to write
500  *  Out:
501  *      none
502  *
503  * Return Value: true if succeeded; false if failed.
504  *
505  */
IFRFbWriteEmbedded(struct vnt_private * priv,unsigned long dwData)506 bool IFRFbWriteEmbedded(struct vnt_private *priv, unsigned long dwData)
507 {
508 	void __iomem *dwIoBase = priv->PortOffset;
509 	unsigned short ww;
510 	unsigned long dwValue;
511 
512 	VNSvOutPortD(dwIoBase + MAC_REG_IFREGCTL, dwData);
513 
514 	/* W_MAX_TIMEOUT is the timeout period */
515 	for (ww = 0; ww < W_MAX_TIMEOUT; ww++) {
516 		VNSvInPortD(dwIoBase + MAC_REG_IFREGCTL, &dwValue);
517 		if (dwValue & IFREGCTL_DONE)
518 			break;
519 	}
520 
521 	if (ww == W_MAX_TIMEOUT)
522 		return false;
523 
524 	return true;
525 }
526 
527 /*
528  * Description: AIROHA IFRF chip init function
529  *
530  * Parameters:
531  *  In:
532  *      dwIoBase    - I/O base address
533  *  Out:
534  *      none
535  *
536  * Return Value: true if succeeded; false if failed.
537  *
538  */
RFbAL2230Init(struct vnt_private * priv)539 static bool RFbAL2230Init(struct vnt_private *priv)
540 {
541 	void __iomem *dwIoBase = priv->PortOffset;
542 	int     ii;
543 	bool bResult;
544 
545 	bResult = true;
546 
547 	/* 3-wire control for normal mode */
548 	VNSvOutPortB(dwIoBase + MAC_REG_SOFTPWRCTL, 0);
549 
550 	MACvWordRegBitsOn(dwIoBase, MAC_REG_SOFTPWRCTL, (SOFTPWRCTL_SWPECTI  |
551 							 SOFTPWRCTL_TXPEINV));
552 	/* PLL  Off */
553 	MACvWordRegBitsOff(dwIoBase, MAC_REG_SOFTPWRCTL, SOFTPWRCTL_SWPE3);
554 
555 	/* patch abnormal AL2230 frequency output */
556 	IFRFbWriteEmbedded(priv, (0x07168700+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW));
557 
558 	for (ii = 0; ii < CB_AL2230_INIT_SEQ; ii++)
559 		bResult &= IFRFbWriteEmbedded(priv, dwAL2230InitTable[ii]);
560 	MACvTimer0MicroSDelay(dwIoBase, 30); //delay 30 us
561 
562 	/* PLL On */
563 	MACvWordRegBitsOn(dwIoBase, MAC_REG_SOFTPWRCTL, SOFTPWRCTL_SWPE3);
564 
565 	MACvTimer0MicroSDelay(dwIoBase, 150);//150us
566 	bResult &= IFRFbWriteEmbedded(priv, (0x00d80f00+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW));
567 	MACvTimer0MicroSDelay(dwIoBase, 30);//30us
568 	bResult &= IFRFbWriteEmbedded(priv, (0x00780f00+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW));
569 	MACvTimer0MicroSDelay(dwIoBase, 30);//30us
570 	bResult &= IFRFbWriteEmbedded(priv, dwAL2230InitTable[CB_AL2230_INIT_SEQ-1]);
571 
572 	MACvWordRegBitsOn(dwIoBase, MAC_REG_SOFTPWRCTL, (SOFTPWRCTL_SWPE3    |
573 							 SOFTPWRCTL_SWPE2    |
574 							 SOFTPWRCTL_SWPECTI  |
575 							 SOFTPWRCTL_TXPEINV));
576 
577 	/* 3-wire control for power saving mode */
578 	VNSvOutPortB(dwIoBase + MAC_REG_PSPWRSIG, (PSSIG_WPE3 | PSSIG_WPE2)); //1100 0000
579 
580 	return bResult;
581 }
582 
RFbAL2230SelectChannel(struct vnt_private * priv,unsigned char byChannel)583 static bool RFbAL2230SelectChannel(struct vnt_private *priv, unsigned char byChannel)
584 {
585 	void __iomem *dwIoBase = priv->PortOffset;
586 	bool bResult;
587 
588 	bResult = true;
589 
590 	bResult &= IFRFbWriteEmbedded(priv, dwAL2230ChannelTable0[byChannel - 1]);
591 	bResult &= IFRFbWriteEmbedded(priv, dwAL2230ChannelTable1[byChannel - 1]);
592 
593 	/* Set Channel[7] = 0 to tell H/W channel is changing now. */
594 	VNSvOutPortB(dwIoBase + MAC_REG_CHANNEL, (byChannel & 0x7F));
595 	MACvTimer0MicroSDelay(dwIoBase, SWITCH_CHANNEL_DELAY_AL2230);
596 	/* Set Channel[7] = 1 to tell H/W channel change is done. */
597 	VNSvOutPortB(dwIoBase + MAC_REG_CHANNEL, (byChannel | 0x80));
598 
599 	return bResult;
600 }
601 
602 /*
603  * Description: RF init function
604  *
605  * Parameters:
606  *  In:
607  *      byBBType
608  *      byRFType
609  *  Out:
610  *      none
611  *
612  * Return Value: true if succeeded; false if failed.
613  *
614  */
RFbInit(struct vnt_private * priv)615 bool RFbInit(
616 	struct vnt_private *priv
617 )
618 {
619 	bool bResult = true;
620 
621 	switch (priv->byRFType) {
622 	case RF_AIROHA:
623 	case RF_AL2230S:
624 		priv->byMaxPwrLevel = AL2230_PWR_IDX_LEN;
625 		bResult = RFbAL2230Init(priv);
626 		break;
627 	case RF_AIROHA7230:
628 		priv->byMaxPwrLevel = AL7230_PWR_IDX_LEN;
629 		bResult = s_bAL7230Init(priv);
630 		break;
631 	case RF_NOTHING:
632 		bResult = true;
633 		break;
634 	default:
635 		bResult = false;
636 		break;
637 	}
638 	return bResult;
639 }
640 
641 /*
642  * Description: Select channel
643  *
644  * Parameters:
645  *  In:
646  *      byRFType
647  *      byChannel    - Channel number
648  *  Out:
649  *      none
650  *
651  * Return Value: true if succeeded; false if failed.
652  *
653  */
RFbSelectChannel(struct vnt_private * priv,unsigned char byRFType,u16 byChannel)654 bool RFbSelectChannel(struct vnt_private *priv, unsigned char byRFType,
655 		      u16 byChannel)
656 {
657 	bool bResult = true;
658 
659 	switch (byRFType) {
660 	case RF_AIROHA:
661 	case RF_AL2230S:
662 		bResult = RFbAL2230SelectChannel(priv, byChannel);
663 		break;
664 		//{{ RobertYu: 20050104
665 	case RF_AIROHA7230:
666 		bResult = s_bAL7230SelectChannel(priv, byChannel);
667 		break;
668 		//}} RobertYu
669 	case RF_NOTHING:
670 		bResult = true;
671 		break;
672 	default:
673 		bResult = false;
674 		break;
675 	}
676 	return bResult;
677 }
678 
679 /*
680  * Description: Write WakeProgSyn
681  *
682  * Parameters:
683  *  In:
684  *      dwIoBase    - I/O base address
685  *      uChannel    - channel number
686  *      bySleepCnt  - SleepProgSyn count
687  *
688  * Return Value: None.
689  *
690  */
RFvWriteWakeProgSyn(struct vnt_private * priv,unsigned char byRFType,u16 uChannel)691 bool RFvWriteWakeProgSyn(struct vnt_private *priv, unsigned char byRFType,
692 			 u16 uChannel)
693 {
694 	void __iomem *dwIoBase = priv->PortOffset;
695 	int   ii;
696 	unsigned char byInitCount = 0;
697 	unsigned char bySleepCount = 0;
698 
699 	VNSvOutPortW(dwIoBase + MAC_REG_MISCFFNDEX, 0);
700 	switch (byRFType) {
701 	case RF_AIROHA:
702 	case RF_AL2230S:
703 
704 		if (uChannel > CB_MAX_CHANNEL_24G)
705 			return false;
706 
707 		 /* Init Reg + Channel Reg (2) */
708 		byInitCount = CB_AL2230_INIT_SEQ + 2;
709 		bySleepCount = 0;
710 		if (byInitCount > (MISCFIFO_SYNDATASIZE - bySleepCount))
711 			return false;
712 
713 		for (ii = 0; ii < CB_AL2230_INIT_SEQ; ii++)
714 			MACvSetMISCFifo(dwIoBase, (unsigned short)(MISCFIFO_SYNDATA_IDX + ii), dwAL2230InitTable[ii]);
715 
716 		MACvSetMISCFifo(dwIoBase, (unsigned short)(MISCFIFO_SYNDATA_IDX + ii), dwAL2230ChannelTable0[uChannel-1]);
717 		ii++;
718 		MACvSetMISCFifo(dwIoBase, (unsigned short)(MISCFIFO_SYNDATA_IDX + ii), dwAL2230ChannelTable1[uChannel-1]);
719 		break;
720 
721 		/* Need to check, PLLON need to be low for channel setting */
722 	case RF_AIROHA7230:
723 		 /* Init Reg + Channel Reg (3) */
724 		byInitCount = CB_AL7230_INIT_SEQ + 3;
725 		bySleepCount = 0;
726 		if (byInitCount > (MISCFIFO_SYNDATASIZE - bySleepCount))
727 			return false;
728 
729 		if (uChannel <= CB_MAX_CHANNEL_24G) {
730 			for (ii = 0; ii < CB_AL7230_INIT_SEQ; ii++)
731 				MACvSetMISCFifo(dwIoBase, (unsigned short)(MISCFIFO_SYNDATA_IDX + ii), dwAL7230InitTable[ii]);
732 		} else {
733 			for (ii = 0; ii < CB_AL7230_INIT_SEQ; ii++)
734 				MACvSetMISCFifo(dwIoBase, (unsigned short)(MISCFIFO_SYNDATA_IDX + ii), dwAL7230InitTableAMode[ii]);
735 		}
736 
737 		MACvSetMISCFifo(dwIoBase, (unsigned short)(MISCFIFO_SYNDATA_IDX + ii), dwAL7230ChannelTable0[uChannel-1]);
738 		ii++;
739 		MACvSetMISCFifo(dwIoBase, (unsigned short)(MISCFIFO_SYNDATA_IDX + ii), dwAL7230ChannelTable1[uChannel-1]);
740 		ii++;
741 		MACvSetMISCFifo(dwIoBase, (unsigned short)(MISCFIFO_SYNDATA_IDX + ii), dwAL7230ChannelTable2[uChannel-1]);
742 		break;
743 
744 	case RF_NOTHING:
745 		return true;
746 
747 	default:
748 		return false;
749 	}
750 
751 	MACvSetMISCFifo(dwIoBase, MISCFIFO_SYNINFO_IDX, (unsigned long)MAKEWORD(bySleepCount, byInitCount));
752 
753 	return true;
754 }
755 
756 /*
757  * Description: Set Tx power
758  *
759  * Parameters:
760  *  In:
761  *      dwIoBase       - I/O base address
762  *      dwRFPowerTable - RF Tx Power Setting
763  *  Out:
764  *      none
765  *
766  * Return Value: true if succeeded; false if failed.
767  *
768  */
RFbSetPower(struct vnt_private * priv,unsigned int uRATE,u16 uCH)769 bool RFbSetPower(
770 	struct vnt_private *priv,
771 	unsigned int uRATE,
772 	u16 uCH
773 )
774 {
775 	bool bResult = true;
776 	unsigned char byPwr = 0;
777 	unsigned char byDec = 0;
778 
779 	if (priv->dwDiagRefCount != 0)
780 		return true;
781 
782 	if ((uCH < 1) || (uCH > CB_MAX_CHANNEL))
783 		return false;
784 
785 	switch (uRATE) {
786 	case RATE_1M:
787 	case RATE_2M:
788 	case RATE_5M:
789 	case RATE_11M:
790 		if (uCH > CB_MAX_CHANNEL_24G)
791 			return false;
792 
793 		byPwr = priv->abyCCKPwrTbl[uCH];
794 		break;
795 	case RATE_6M:
796 	case RATE_9M:
797 	case RATE_12M:
798 	case RATE_18M:
799 		byPwr = priv->abyOFDMPwrTbl[uCH];
800 		if (priv->byRFType == RF_UW2452)
801 			byDec = byPwr + 14;
802 		else
803 			byDec = byPwr + 10;
804 
805 		if (byDec >= priv->byMaxPwrLevel)
806 			byDec = priv->byMaxPwrLevel-1;
807 
808 		byPwr = byDec;
809 		break;
810 	case RATE_24M:
811 	case RATE_36M:
812 	case RATE_48M:
813 	case RATE_54M:
814 		byPwr = priv->abyOFDMPwrTbl[uCH];
815 		break;
816 	}
817 
818 	if (priv->byCurPwr == byPwr)
819 		return true;
820 
821 	bResult = RFbRawSetPower(priv, byPwr, uRATE);
822 	if (bResult)
823 		priv->byCurPwr = byPwr;
824 
825 	return bResult;
826 }
827 
828 /*
829  * Description: Set Tx power
830  *
831  * Parameters:
832  *  In:
833  *      dwIoBase       - I/O base address
834  *      dwRFPowerTable - RF Tx Power Setting
835  *  Out:
836  *      none
837  *
838  * Return Value: true if succeeded; false if failed.
839  *
840  */
841 
RFbRawSetPower(struct vnt_private * priv,unsigned char byPwr,unsigned int uRATE)842 bool RFbRawSetPower(
843 	struct vnt_private *priv,
844 	unsigned char byPwr,
845 	unsigned int uRATE
846 )
847 {
848 	bool bResult = true;
849 	unsigned long dwMax7230Pwr = 0;
850 
851 	if (byPwr >=  priv->byMaxPwrLevel)
852 		return false;
853 
854 	switch (priv->byRFType) {
855 	case RF_AIROHA:
856 		bResult &= IFRFbWriteEmbedded(priv, dwAL2230PowerTable[byPwr]);
857 		if (uRATE <= RATE_11M)
858 			bResult &= IFRFbWriteEmbedded(priv, 0x0001B400+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW);
859 		else
860 			bResult &= IFRFbWriteEmbedded(priv, 0x0005A400+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW);
861 
862 		break;
863 
864 	case RF_AL2230S:
865 		bResult &= IFRFbWriteEmbedded(priv, dwAL2230PowerTable[byPwr]);
866 		if (uRATE <= RATE_11M) {
867 			bResult &= IFRFbWriteEmbedded(priv, 0x040C1400+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW);
868 			bResult &= IFRFbWriteEmbedded(priv, 0x00299B00+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW);
869 		} else {
870 			bResult &= IFRFbWriteEmbedded(priv, 0x0005A400+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW);
871 			bResult &= IFRFbWriteEmbedded(priv, 0x00099B00+(BY_AL2230_REG_LEN<<3)+IFREGCTL_REGW);
872 		}
873 
874 		break;
875 
876 	case RF_AIROHA7230:
877 		/* 0x080F1B00 for 3 wire control TxGain(D10)
878 		 * and 0x31 as TX Gain value */
879 		dwMax7230Pwr = 0x080C0B00 | ((byPwr) << 12) |
880 			(BY_AL7230_REG_LEN << 3)  | IFREGCTL_REGW;
881 
882 		bResult &= IFRFbWriteEmbedded(priv, dwMax7230Pwr);
883 		break;
884 
885 	default:
886 		break;
887 	}
888 	return bResult;
889 }
890 
891 /*+
892  *
893  * Routine Description:
894  *     Translate RSSI to dBm
895  *
896  * Parameters:
897  *  In:
898  *      priv         - The adapter to be translated
899  *      byCurrRSSI      - RSSI to be translated
900  *  Out:
901  *      pdwdbm          - Translated dbm number
902  *
903  * Return Value: none
904  *
905  -*/
906 void
RFvRSSITodBm(struct vnt_private * priv,unsigned char byCurrRSSI,long * pldBm)907 RFvRSSITodBm(
908 	struct vnt_private *priv,
909 	unsigned char byCurrRSSI,
910 	long *pldBm
911 	)
912 {
913 	unsigned char byIdx = (((byCurrRSSI & 0xC0) >> 6) & 0x03);
914 	long b = (byCurrRSSI & 0x3F);
915 	long a = 0;
916 	unsigned char abyAIROHARF[4] = {0, 18, 0, 40};
917 
918 	switch (priv->byRFType) {
919 	case RF_AIROHA:
920 	case RF_AL2230S:
921 	case RF_AIROHA7230:
922 		a = abyAIROHARF[byIdx];
923 		break;
924 	default:
925 		break;
926 	}
927 
928 	*pldBm = -1 * (a + b * 2);
929 }
930 
931 /* Post processing for the 11b/g and 11a.
932  * for save time on changing Reg2,3,5,7,10,12,15 */
RFbAL7230SelectChannelPostProcess(struct vnt_private * priv,u16 byOldChannel,u16 byNewChannel)933 bool RFbAL7230SelectChannelPostProcess(struct vnt_private *priv,
934 				       u16 byOldChannel,
935 				       u16 byNewChannel)
936 {
937 	bool bResult;
938 
939 	bResult = true;
940 
941 	/* if change between 11 b/g and 11a need to update the following
942 	 * register
943 	 * Channel Index 1~14 */
944 	if ((byOldChannel <= CB_MAX_CHANNEL_24G) && (byNewChannel > CB_MAX_CHANNEL_24G)) {
945 		/* Change from 2.4G to 5G [Reg] */
946 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTableAMode[2]);
947 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTableAMode[3]);
948 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTableAMode[5]);
949 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTableAMode[7]);
950 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTableAMode[10]);
951 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTableAMode[12]);
952 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTableAMode[15]);
953 	} else if ((byOldChannel > CB_MAX_CHANNEL_24G) && (byNewChannel <= CB_MAX_CHANNEL_24G)) {
954 		/* Change from 5G to 2.4G [Reg] */
955 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTable[2]);
956 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTable[3]);
957 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTable[5]);
958 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTable[7]);
959 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTable[10]);
960 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTable[12]);
961 		bResult &= IFRFbWriteEmbedded(priv, dwAL7230InitTable[15]);
962 	}
963 
964 	return bResult;
965 }
966