1 /*
2  * Copyright (c) 2012 Qualcomm Atheros, Inc.
3  *
4  * Permission to use, copy, modify, and/or distribute this software for any
5  * purpose with or without fee is hereby granted, provided that the above
6  * copyright notice and this permission notice appear in all copies.
7  *
8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15  */
16 
17 #include "ath9k.h"
18 
19 /*
20  * AR9285
21  * ======
22  *
23  * EEPROM has 2 4-bit fields containing the card configuration.
24  *
25  * antdiv_ctl1:
26  * ------------
27  * bb_enable_ant_div_lnadiv : 1
28  * bb_ant_div_alt_gaintb    : 1
29  * bb_ant_div_main_gaintb   : 1
30  * bb_enable_ant_fast_div   : 1
31  *
32  * antdiv_ctl2:
33  * -----------
34  * bb_ant_div_alt_lnaconf  : 2
35  * bb_ant_div_main_lnaconf : 2
36  *
37  * The EEPROM bits are used as follows:
38  * ------------------------------------
39  *
40  * bb_enable_ant_div_lnadiv      - Enable LNA path rx antenna diversity/combining.
41  *                                 Set in AR_PHY_MULTICHAIN_GAIN_CTL.
42  *
43  * bb_ant_div_[alt/main]_gaintb  - 0 -> Antenna config Alt/Main uses gaintable 0
44  *                                 1 -> Antenna config Alt/Main uses gaintable 1
45  *                                 Set in AR_PHY_MULTICHAIN_GAIN_CTL.
46  *
47  * bb_enable_ant_fast_div        - Enable fast antenna diversity.
48  *                                 Set in AR_PHY_CCK_DETECT.
49  *
50  * bb_ant_div_[alt/main]_lnaconf - Alt/Main LNA diversity/combining input config.
51  *                                 Set in AR_PHY_MULTICHAIN_GAIN_CTL.
52  *                                 10=LNA1
53  *                                 01=LNA2
54  *                                 11=LNA1+LNA2
55  *                                 00=LNA1-LNA2
56  *
57  * AR9485 / AR9565 / AR9331
58  * ========================
59  *
60  * The same bits are present in the EEPROM, but the location in the
61  * EEPROM is different (ant_div_control in ar9300_BaseExtension_1).
62  *
63  * ant_div_alt_lnaconf      ==> bit 0~1
64  * ant_div_main_lnaconf     ==> bit 2~3
65  * ant_div_alt_gaintb       ==> bit 4
66  * ant_div_main_gaintb      ==> bit 5
67  * enable_ant_div_lnadiv    ==> bit 6
68  * enable_ant_fast_div      ==> bit 7
69  */
70 
ath_is_alt_ant_ratio_better(struct ath_ant_comb * antcomb,int alt_ratio,int maxdelta,int mindelta,int main_rssi_avg,int alt_rssi_avg,int pkt_count)71 static inline bool ath_is_alt_ant_ratio_better(struct ath_ant_comb *antcomb,
72 					       int alt_ratio, int maxdelta,
73 					       int mindelta, int main_rssi_avg,
74 					       int alt_rssi_avg, int pkt_count)
75 {
76 	if (pkt_count <= 50)
77 		return false;
78 
79 	if (alt_rssi_avg > main_rssi_avg + mindelta)
80 		return true;
81 
82 	if (alt_ratio >= antcomb->ant_ratio2 &&
83 	    alt_rssi_avg >= antcomb->low_rssi_thresh &&
84 	    (alt_rssi_avg > main_rssi_avg + maxdelta))
85 		return true;
86 
87 	return false;
88 }
89 
ath_ant_div_comb_alt_check(struct ath_hw_antcomb_conf * conf,struct ath_ant_comb * antcomb,int alt_ratio,int alt_rssi_avg,int main_rssi_avg)90 static inline bool ath_ant_div_comb_alt_check(struct ath_hw_antcomb_conf *conf,
91 					      struct ath_ant_comb *antcomb,
92 					      int alt_ratio, int alt_rssi_avg,
93 					      int main_rssi_avg)
94 {
95 	bool result, set1, set2;
96 
97 	result = set1 = set2 = false;
98 
99 	if (conf->main_lna_conf == ATH_ANT_DIV_COMB_LNA2 &&
100 	    conf->alt_lna_conf == ATH_ANT_DIV_COMB_LNA1)
101 		set1 = true;
102 
103 	if (conf->main_lna_conf == ATH_ANT_DIV_COMB_LNA1 &&
104 	    conf->alt_lna_conf == ATH_ANT_DIV_COMB_LNA2)
105 		set2 = true;
106 
107 	switch (conf->div_group) {
108 	case 0:
109 		if (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO)
110 			result = true;
111 		break;
112 	case 1:
113 	case 2:
114 		if (alt_rssi_avg < 4 || alt_rssi_avg < antcomb->low_rssi_thresh)
115 			break;
116 
117 		if ((set1 && (alt_rssi_avg >= (main_rssi_avg - 5))) ||
118 		    (set2 && (alt_rssi_avg >= (main_rssi_avg - 2))) ||
119 		    (alt_ratio > antcomb->ant_ratio))
120 			result = true;
121 
122 		break;
123 	case 3:
124 		if (alt_rssi_avg < 4 || alt_rssi_avg < antcomb->low_rssi_thresh)
125 			break;
126 
127 		if ((set1 && (alt_rssi_avg >= (main_rssi_avg - 3))) ||
128 		    (set2 && (alt_rssi_avg >= (main_rssi_avg + 3))) ||
129 		    (alt_ratio > antcomb->ant_ratio))
130 			result = true;
131 
132 		break;
133 	}
134 
135 	return result;
136 }
137 
ath_lnaconf_alt_good_scan(struct ath_ant_comb * antcomb,struct ath_hw_antcomb_conf ant_conf,int main_rssi_avg)138 static void ath_lnaconf_alt_good_scan(struct ath_ant_comb *antcomb,
139 				      struct ath_hw_antcomb_conf ant_conf,
140 				      int main_rssi_avg)
141 {
142 	antcomb->quick_scan_cnt = 0;
143 
144 	if (ant_conf.main_lna_conf == ATH_ANT_DIV_COMB_LNA2)
145 		antcomb->rssi_lna2 = main_rssi_avg;
146 	else if (ant_conf.main_lna_conf == ATH_ANT_DIV_COMB_LNA1)
147 		antcomb->rssi_lna1 = main_rssi_avg;
148 
149 	switch ((ant_conf.main_lna_conf << 4) | ant_conf.alt_lna_conf) {
150 	case 0x10: /* LNA2 A-B */
151 		antcomb->main_conf = ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
152 		antcomb->first_quick_scan_conf =
153 			ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
154 		antcomb->second_quick_scan_conf = ATH_ANT_DIV_COMB_LNA1;
155 		break;
156 	case 0x20: /* LNA1 A-B */
157 		antcomb->main_conf = ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
158 		antcomb->first_quick_scan_conf =
159 			ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
160 		antcomb->second_quick_scan_conf = ATH_ANT_DIV_COMB_LNA2;
161 		break;
162 	case 0x21: /* LNA1 LNA2 */
163 		antcomb->main_conf = ATH_ANT_DIV_COMB_LNA2;
164 		antcomb->first_quick_scan_conf =
165 			ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
166 		antcomb->second_quick_scan_conf =
167 			ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
168 		break;
169 	case 0x12: /* LNA2 LNA1 */
170 		antcomb->main_conf = ATH_ANT_DIV_COMB_LNA1;
171 		antcomb->first_quick_scan_conf =
172 			ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
173 		antcomb->second_quick_scan_conf =
174 			ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
175 		break;
176 	case 0x13: /* LNA2 A+B */
177 		antcomb->main_conf = ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
178 		antcomb->first_quick_scan_conf =
179 			ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
180 		antcomb->second_quick_scan_conf = ATH_ANT_DIV_COMB_LNA1;
181 		break;
182 	case 0x23: /* LNA1 A+B */
183 		antcomb->main_conf = ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
184 		antcomb->first_quick_scan_conf =
185 			ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
186 		antcomb->second_quick_scan_conf = ATH_ANT_DIV_COMB_LNA2;
187 		break;
188 	default:
189 		break;
190 	}
191 }
192 
ath_ant_set_alt_ratio(struct ath_ant_comb * antcomb,struct ath_hw_antcomb_conf * conf)193 static void ath_ant_set_alt_ratio(struct ath_ant_comb *antcomb,
194 				  struct ath_hw_antcomb_conf *conf)
195 {
196 	/* set alt to the conf with maximun ratio */
197 	if (antcomb->first_ratio && antcomb->second_ratio) {
198 		if (antcomb->rssi_second > antcomb->rssi_third) {
199 			/* first alt*/
200 			if ((antcomb->first_quick_scan_conf == ATH_ANT_DIV_COMB_LNA1) ||
201 			    (antcomb->first_quick_scan_conf == ATH_ANT_DIV_COMB_LNA2))
202 				/* Set alt LNA1 or LNA2*/
203 				if (conf->main_lna_conf == ATH_ANT_DIV_COMB_LNA2)
204 					conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1;
205 				else
206 					conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA2;
207 			else
208 				/* Set alt to A+B or A-B */
209 				conf->alt_lna_conf =
210 					antcomb->first_quick_scan_conf;
211 		} else if ((antcomb->second_quick_scan_conf == ATH_ANT_DIV_COMB_LNA1) ||
212 			   (antcomb->second_quick_scan_conf == ATH_ANT_DIV_COMB_LNA2)) {
213 			/* Set alt LNA1 or LNA2 */
214 			if (conf->main_lna_conf == ATH_ANT_DIV_COMB_LNA2)
215 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1;
216 			else
217 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA2;
218 		} else {
219 			/* Set alt to A+B or A-B */
220 			conf->alt_lna_conf = antcomb->second_quick_scan_conf;
221 		}
222 	} else if (antcomb->first_ratio) {
223 		/* first alt */
224 		if ((antcomb->first_quick_scan_conf == ATH_ANT_DIV_COMB_LNA1) ||
225 		    (antcomb->first_quick_scan_conf == ATH_ANT_DIV_COMB_LNA2))
226 			/* Set alt LNA1 or LNA2 */
227 			if (conf->main_lna_conf == ATH_ANT_DIV_COMB_LNA2)
228 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1;
229 			else
230 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA2;
231 		else
232 			/* Set alt to A+B or A-B */
233 			conf->alt_lna_conf = antcomb->first_quick_scan_conf;
234 	} else if (antcomb->second_ratio) {
235 		/* second alt */
236 		if ((antcomb->second_quick_scan_conf == ATH_ANT_DIV_COMB_LNA1) ||
237 		    (antcomb->second_quick_scan_conf == ATH_ANT_DIV_COMB_LNA2))
238 			/* Set alt LNA1 or LNA2 */
239 			if (conf->main_lna_conf == ATH_ANT_DIV_COMB_LNA2)
240 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1;
241 			else
242 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA2;
243 		else
244 			/* Set alt to A+B or A-B */
245 			conf->alt_lna_conf = antcomb->second_quick_scan_conf;
246 	} else {
247 		/* main is largest */
248 		if ((antcomb->main_conf == ATH_ANT_DIV_COMB_LNA1) ||
249 		    (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA2))
250 			/* Set alt LNA1 or LNA2 */
251 			if (conf->main_lna_conf == ATH_ANT_DIV_COMB_LNA2)
252 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1;
253 			else
254 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA2;
255 		else
256 			/* Set alt to A+B or A-B */
257 			conf->alt_lna_conf = antcomb->main_conf;
258 	}
259 }
260 
ath_select_ant_div_from_quick_scan(struct ath_ant_comb * antcomb,struct ath_hw_antcomb_conf * div_ant_conf,int main_rssi_avg,int alt_rssi_avg,int alt_ratio)261 static void ath_select_ant_div_from_quick_scan(struct ath_ant_comb *antcomb,
262 				       struct ath_hw_antcomb_conf *div_ant_conf,
263 				       int main_rssi_avg, int alt_rssi_avg,
264 				       int alt_ratio)
265 {
266 	/* alt_good */
267 	switch (antcomb->quick_scan_cnt) {
268 	case 0:
269 		/* set alt to main, and alt to first conf */
270 		div_ant_conf->main_lna_conf = antcomb->main_conf;
271 		div_ant_conf->alt_lna_conf = antcomb->first_quick_scan_conf;
272 		break;
273 	case 1:
274 		/* set alt to main, and alt to first conf */
275 		div_ant_conf->main_lna_conf = antcomb->main_conf;
276 		div_ant_conf->alt_lna_conf = antcomb->second_quick_scan_conf;
277 		antcomb->rssi_first = main_rssi_avg;
278 		antcomb->rssi_second = alt_rssi_avg;
279 
280 		if (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA1) {
281 			/* main is LNA1 */
282 			if (ath_is_alt_ant_ratio_better(antcomb, alt_ratio,
283 						ATH_ANT_DIV_COMB_LNA1_DELTA_HI,
284 						ATH_ANT_DIV_COMB_LNA1_DELTA_LOW,
285 						main_rssi_avg, alt_rssi_avg,
286 						antcomb->total_pkt_count))
287 				antcomb->first_ratio = true;
288 			else
289 				antcomb->first_ratio = false;
290 		} else if (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA2) {
291 			if (ath_is_alt_ant_ratio_better(antcomb, alt_ratio,
292 						ATH_ANT_DIV_COMB_LNA1_DELTA_MID,
293 						ATH_ANT_DIV_COMB_LNA1_DELTA_LOW,
294 						main_rssi_avg, alt_rssi_avg,
295 						antcomb->total_pkt_count))
296 				antcomb->first_ratio = true;
297 			else
298 				antcomb->first_ratio = false;
299 		} else {
300 			if (ath_is_alt_ant_ratio_better(antcomb, alt_ratio,
301 						ATH_ANT_DIV_COMB_LNA1_DELTA_HI,
302 						0,
303 						main_rssi_avg, alt_rssi_avg,
304 						antcomb->total_pkt_count))
305 				antcomb->first_ratio = true;
306 			else
307 				antcomb->first_ratio = false;
308 		}
309 		break;
310 	case 2:
311 		antcomb->alt_good = false;
312 		antcomb->scan_not_start = false;
313 		antcomb->scan = false;
314 		antcomb->rssi_first = main_rssi_avg;
315 		antcomb->rssi_third = alt_rssi_avg;
316 
317 		switch(antcomb->second_quick_scan_conf) {
318 		case ATH_ANT_DIV_COMB_LNA1:
319 			antcomb->rssi_lna1 = alt_rssi_avg;
320 			break;
321 		case ATH_ANT_DIV_COMB_LNA2:
322 			antcomb->rssi_lna2 = alt_rssi_avg;
323 			break;
324 		case ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2:
325 			if (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA2)
326 				antcomb->rssi_lna2 = main_rssi_avg;
327 			else if (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA1)
328 				antcomb->rssi_lna1 = main_rssi_avg;
329 			break;
330 		default:
331 			break;
332 		}
333 
334 		if (antcomb->rssi_lna2 > antcomb->rssi_lna1 +
335 		    div_ant_conf->lna1_lna2_switch_delta)
336 			div_ant_conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA2;
337 		else
338 			div_ant_conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA1;
339 
340 		if (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA1) {
341 			if (ath_is_alt_ant_ratio_better(antcomb, alt_ratio,
342 						ATH_ANT_DIV_COMB_LNA1_DELTA_HI,
343 						ATH_ANT_DIV_COMB_LNA1_DELTA_LOW,
344 						main_rssi_avg, alt_rssi_avg,
345 						antcomb->total_pkt_count))
346 				antcomb->second_ratio = true;
347 			else
348 				antcomb->second_ratio = false;
349 		} else if (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA2) {
350 			if (ath_is_alt_ant_ratio_better(antcomb, alt_ratio,
351 						ATH_ANT_DIV_COMB_LNA1_DELTA_MID,
352 						ATH_ANT_DIV_COMB_LNA1_DELTA_LOW,
353 						main_rssi_avg, alt_rssi_avg,
354 						antcomb->total_pkt_count))
355 				antcomb->second_ratio = true;
356 			else
357 				antcomb->second_ratio = false;
358 		} else {
359 			if (ath_is_alt_ant_ratio_better(antcomb, alt_ratio,
360 						ATH_ANT_DIV_COMB_LNA1_DELTA_HI,
361 						0,
362 						main_rssi_avg, alt_rssi_avg,
363 						antcomb->total_pkt_count))
364 				antcomb->second_ratio = true;
365 			else
366 				antcomb->second_ratio = false;
367 		}
368 
369 		ath_ant_set_alt_ratio(antcomb, div_ant_conf);
370 
371 		break;
372 	default:
373 		break;
374 	}
375 }
376 
ath_ant_div_conf_fast_divbias(struct ath_hw_antcomb_conf * ant_conf,struct ath_ant_comb * antcomb,int alt_ratio)377 static void ath_ant_div_conf_fast_divbias(struct ath_hw_antcomb_conf *ant_conf,
378 					  struct ath_ant_comb *antcomb,
379 					  int alt_ratio)
380 {
381 	ant_conf->main_gaintb = 0;
382 	ant_conf->alt_gaintb = 0;
383 
384 	if (ant_conf->div_group == 0) {
385 		/* Adjust the fast_div_bias based on main and alt lna conf */
386 		switch ((ant_conf->main_lna_conf << 4) |
387 				ant_conf->alt_lna_conf) {
388 		case 0x01: /* A-B LNA2 */
389 			ant_conf->fast_div_bias = 0x3b;
390 			break;
391 		case 0x02: /* A-B LNA1 */
392 			ant_conf->fast_div_bias = 0x3d;
393 			break;
394 		case 0x03: /* A-B A+B */
395 			ant_conf->fast_div_bias = 0x1;
396 			break;
397 		case 0x10: /* LNA2 A-B */
398 			ant_conf->fast_div_bias = 0x7;
399 			break;
400 		case 0x12: /* LNA2 LNA1 */
401 			ant_conf->fast_div_bias = 0x2;
402 			break;
403 		case 0x13: /* LNA2 A+B */
404 			ant_conf->fast_div_bias = 0x7;
405 			break;
406 		case 0x20: /* LNA1 A-B */
407 			ant_conf->fast_div_bias = 0x6;
408 			break;
409 		case 0x21: /* LNA1 LNA2 */
410 			ant_conf->fast_div_bias = 0x0;
411 			break;
412 		case 0x23: /* LNA1 A+B */
413 			ant_conf->fast_div_bias = 0x6;
414 			break;
415 		case 0x30: /* A+B A-B */
416 			ant_conf->fast_div_bias = 0x1;
417 			break;
418 		case 0x31: /* A+B LNA2 */
419 			ant_conf->fast_div_bias = 0x3b;
420 			break;
421 		case 0x32: /* A+B LNA1 */
422 			ant_conf->fast_div_bias = 0x3d;
423 			break;
424 		default:
425 			break;
426 		}
427 	} else if (ant_conf->div_group == 1) {
428 		/* Adjust the fast_div_bias based on main and alt_lna_conf */
429 		switch ((ant_conf->main_lna_conf << 4) |
430 			ant_conf->alt_lna_conf) {
431 		case 0x01: /* A-B LNA2 */
432 			ant_conf->fast_div_bias = 0x1;
433 			break;
434 		case 0x02: /* A-B LNA1 */
435 			ant_conf->fast_div_bias = 0x1;
436 			break;
437 		case 0x03: /* A-B A+B */
438 			ant_conf->fast_div_bias = 0x1;
439 			break;
440 		case 0x10: /* LNA2 A-B */
441 			if (!(antcomb->scan) &&
442 			    (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO))
443 				ant_conf->fast_div_bias = 0x3f;
444 			else
445 				ant_conf->fast_div_bias = 0x1;
446 			break;
447 		case 0x12: /* LNA2 LNA1 */
448 			ant_conf->fast_div_bias = 0x1;
449 			break;
450 		case 0x13: /* LNA2 A+B */
451 			if (!(antcomb->scan) &&
452 			    (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO))
453 				ant_conf->fast_div_bias = 0x3f;
454 			else
455 				ant_conf->fast_div_bias = 0x1;
456 			break;
457 		case 0x20: /* LNA1 A-B */
458 			if (!(antcomb->scan) &&
459 			    (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO))
460 				ant_conf->fast_div_bias = 0x3f;
461 			else
462 				ant_conf->fast_div_bias = 0x1;
463 			break;
464 		case 0x21: /* LNA1 LNA2 */
465 			ant_conf->fast_div_bias = 0x1;
466 			break;
467 		case 0x23: /* LNA1 A+B */
468 			if (!(antcomb->scan) &&
469 			    (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO))
470 				ant_conf->fast_div_bias = 0x3f;
471 			else
472 				ant_conf->fast_div_bias = 0x1;
473 			break;
474 		case 0x30: /* A+B A-B */
475 			ant_conf->fast_div_bias = 0x1;
476 			break;
477 		case 0x31: /* A+B LNA2 */
478 			ant_conf->fast_div_bias = 0x1;
479 			break;
480 		case 0x32: /* A+B LNA1 */
481 			ant_conf->fast_div_bias = 0x1;
482 			break;
483 		default:
484 			break;
485 		}
486 	} else if (ant_conf->div_group == 2) {
487 		/* Adjust the fast_div_bias based on main and alt_lna_conf */
488 		switch ((ant_conf->main_lna_conf << 4) |
489 				ant_conf->alt_lna_conf) {
490 		case 0x01: /* A-B LNA2 */
491 			ant_conf->fast_div_bias = 0x1;
492 			break;
493 		case 0x02: /* A-B LNA1 */
494 			ant_conf->fast_div_bias = 0x1;
495 			break;
496 		case 0x03: /* A-B A+B */
497 			ant_conf->fast_div_bias = 0x1;
498 			break;
499 		case 0x10: /* LNA2 A-B */
500 			if (!antcomb->scan && (alt_ratio > antcomb->ant_ratio))
501 				ant_conf->fast_div_bias = 0x1;
502 			else
503 				ant_conf->fast_div_bias = 0x2;
504 			break;
505 		case 0x12: /* LNA2 LNA1 */
506 			ant_conf->fast_div_bias = 0x1;
507 			break;
508 		case 0x13: /* LNA2 A+B */
509 			if (!antcomb->scan && (alt_ratio > antcomb->ant_ratio))
510 				ant_conf->fast_div_bias = 0x1;
511 			else
512 				ant_conf->fast_div_bias = 0x2;
513 			break;
514 		case 0x20: /* LNA1 A-B */
515 			if (!antcomb->scan && (alt_ratio > antcomb->ant_ratio))
516 				ant_conf->fast_div_bias = 0x1;
517 			else
518 				ant_conf->fast_div_bias = 0x2;
519 			break;
520 		case 0x21: /* LNA1 LNA2 */
521 			ant_conf->fast_div_bias = 0x1;
522 			break;
523 		case 0x23: /* LNA1 A+B */
524 			if (!antcomb->scan && (alt_ratio > antcomb->ant_ratio))
525 				ant_conf->fast_div_bias = 0x1;
526 			else
527 				ant_conf->fast_div_bias = 0x2;
528 			break;
529 		case 0x30: /* A+B A-B */
530 			ant_conf->fast_div_bias = 0x1;
531 			break;
532 		case 0x31: /* A+B LNA2 */
533 			ant_conf->fast_div_bias = 0x1;
534 			break;
535 		case 0x32: /* A+B LNA1 */
536 			ant_conf->fast_div_bias = 0x1;
537 			break;
538 		default:
539 			break;
540 		}
541 
542 		if (antcomb->fast_div_bias)
543 			ant_conf->fast_div_bias = antcomb->fast_div_bias;
544 	} else if (ant_conf->div_group == 3) {
545 		switch ((ant_conf->main_lna_conf << 4) |
546 			ant_conf->alt_lna_conf) {
547 		case 0x01: /* A-B LNA2 */
548 			ant_conf->fast_div_bias = 0x1;
549 			break;
550 		case 0x02: /* A-B LNA1 */
551 			ant_conf->fast_div_bias = 0x39;
552 			break;
553 		case 0x03: /* A-B A+B */
554 			ant_conf->fast_div_bias = 0x1;
555 			break;
556 		case 0x10: /* LNA2 A-B */
557 			ant_conf->fast_div_bias = 0x2;
558 			break;
559 		case 0x12: /* LNA2 LNA1 */
560 			ant_conf->fast_div_bias = 0x3f;
561 			break;
562 		case 0x13: /* LNA2 A+B */
563 			ant_conf->fast_div_bias = 0x2;
564 			break;
565 		case 0x20: /* LNA1 A-B */
566 			ant_conf->fast_div_bias = 0x3;
567 			break;
568 		case 0x21: /* LNA1 LNA2 */
569 			ant_conf->fast_div_bias = 0x3;
570 			break;
571 		case 0x23: /* LNA1 A+B */
572 			ant_conf->fast_div_bias = 0x3;
573 			break;
574 		case 0x30: /* A+B A-B */
575 			ant_conf->fast_div_bias = 0x1;
576 			break;
577 		case 0x31: /* A+B LNA2 */
578 			ant_conf->fast_div_bias = 0x6;
579 			break;
580 		case 0x32: /* A+B LNA1 */
581 			ant_conf->fast_div_bias = 0x1;
582 			break;
583 		default:
584 			break;
585 		}
586 	}
587 }
588 
ath_ant_try_scan(struct ath_ant_comb * antcomb,struct ath_hw_antcomb_conf * conf,int curr_alt_set,int alt_rssi_avg,int main_rssi_avg)589 static void ath_ant_try_scan(struct ath_ant_comb *antcomb,
590 			     struct ath_hw_antcomb_conf *conf,
591 			     int curr_alt_set, int alt_rssi_avg,
592 			     int main_rssi_avg)
593 {
594 	switch (curr_alt_set) {
595 	case ATH_ANT_DIV_COMB_LNA2:
596 		antcomb->rssi_lna2 = alt_rssi_avg;
597 		antcomb->rssi_lna1 = main_rssi_avg;
598 		antcomb->scan = true;
599 		/* set to A+B */
600 		conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA1;
601 		conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
602 		break;
603 	case ATH_ANT_DIV_COMB_LNA1:
604 		antcomb->rssi_lna1 = alt_rssi_avg;
605 		antcomb->rssi_lna2 = main_rssi_avg;
606 		antcomb->scan = true;
607 		/* set to A+B */
608 		conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA2;
609 		conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
610 		break;
611 	case ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2:
612 		antcomb->rssi_add = alt_rssi_avg;
613 		antcomb->scan = true;
614 		/* set to A-B */
615 		conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
616 		break;
617 	case ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2:
618 		antcomb->rssi_sub = alt_rssi_avg;
619 		antcomb->scan = false;
620 		if (antcomb->rssi_lna2 >
621 		    (antcomb->rssi_lna1 + conf->lna1_lna2_switch_delta)) {
622 			/* use LNA2 as main LNA */
623 			if ((antcomb->rssi_add > antcomb->rssi_lna1) &&
624 			    (antcomb->rssi_add > antcomb->rssi_sub)) {
625 				/* set to A+B */
626 				conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA2;
627 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
628 			} else if (antcomb->rssi_sub >
629 				   antcomb->rssi_lna1) {
630 				/* set to A-B */
631 				conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA2;
632 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
633 			} else {
634 				/* set to LNA1 */
635 				conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA2;
636 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1;
637 			}
638 		} else {
639 			/* use LNA1 as main LNA */
640 			if ((antcomb->rssi_add > antcomb->rssi_lna2) &&
641 			    (antcomb->rssi_add > antcomb->rssi_sub)) {
642 				/* set to A+B */
643 				conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA1;
644 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
645 			} else if (antcomb->rssi_sub >
646 				   antcomb->rssi_lna2) {
647 				/* set to A-B */
648 				conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA1;
649 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
650 			} else {
651 				/* set to LNA2 */
652 				conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA1;
653 				conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA2;
654 			}
655 		}
656 		break;
657 	default:
658 		break;
659 	}
660 }
661 
ath_ant_try_switch(struct ath_hw_antcomb_conf * div_ant_conf,struct ath_ant_comb * antcomb,int alt_ratio,int alt_rssi_avg,int main_rssi_avg,int curr_main_set,int curr_alt_set)662 static bool ath_ant_try_switch(struct ath_hw_antcomb_conf *div_ant_conf,
663 			       struct ath_ant_comb *antcomb,
664 			       int alt_ratio, int alt_rssi_avg,
665 			       int main_rssi_avg, int curr_main_set,
666 			       int curr_alt_set)
667 {
668 	bool ret = false;
669 
670 	if (ath_ant_div_comb_alt_check(div_ant_conf, antcomb, alt_ratio,
671 				       alt_rssi_avg, main_rssi_avg)) {
672 		if (curr_alt_set == ATH_ANT_DIV_COMB_LNA2) {
673 			/*
674 			 * Switch main and alt LNA.
675 			 */
676 			div_ant_conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA2;
677 			div_ant_conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1;
678 		} else if (curr_alt_set == ATH_ANT_DIV_COMB_LNA1) {
679 			div_ant_conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA1;
680 			div_ant_conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA2;
681 		}
682 
683 		ret = true;
684 	} else if ((curr_alt_set != ATH_ANT_DIV_COMB_LNA1) &&
685 		   (curr_alt_set != ATH_ANT_DIV_COMB_LNA2)) {
686 		/*
687 		  Set alt to another LNA.
688 		*/
689 		if (curr_main_set == ATH_ANT_DIV_COMB_LNA2)
690 			div_ant_conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1;
691 		else if (curr_main_set == ATH_ANT_DIV_COMB_LNA1)
692 			div_ant_conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA2;
693 
694 		ret = true;
695 	}
696 
697 	return ret;
698 }
699 
ath_ant_short_scan_check(struct ath_ant_comb * antcomb)700 static bool ath_ant_short_scan_check(struct ath_ant_comb *antcomb)
701 {
702 	int alt_ratio;
703 
704 	if (!antcomb->scan || !antcomb->alt_good)
705 		return false;
706 
707 	if (time_after(jiffies, antcomb->scan_start_time +
708 		       msecs_to_jiffies(ATH_ANT_DIV_COMB_SHORT_SCAN_INTR)))
709 		return true;
710 
711 	if (antcomb->total_pkt_count == ATH_ANT_DIV_COMB_SHORT_SCAN_PKTCOUNT) {
712 		alt_ratio = ((antcomb->alt_recv_cnt * 100) /
713 			     antcomb->total_pkt_count);
714 		if (alt_ratio < antcomb->ant_ratio)
715 			return true;
716 	}
717 
718 	return false;
719 }
720 
ath_ant_comb_scan(struct ath_softc * sc,struct ath_rx_status * rs)721 void ath_ant_comb_scan(struct ath_softc *sc, struct ath_rx_status *rs)
722 {
723 	struct ath_hw_antcomb_conf div_ant_conf;
724 	struct ath_ant_comb *antcomb = &sc->ant_comb;
725 	int alt_ratio = 0, alt_rssi_avg = 0, main_rssi_avg = 0, curr_alt_set;
726 	int curr_main_set;
727 	int main_rssi = rs->rs_rssi_ctl[0];
728 	int alt_rssi = rs->rs_rssi_ctl[1];
729 	int rx_ant_conf,  main_ant_conf;
730 	bool short_scan = false, ret;
731 
732 	rx_ant_conf = (rs->rs_rssi_ctl[2] >> ATH_ANT_RX_CURRENT_SHIFT) &
733 		       ATH_ANT_RX_MASK;
734 	main_ant_conf = (rs->rs_rssi_ctl[2] >> ATH_ANT_RX_MAIN_SHIFT) &
735 			 ATH_ANT_RX_MASK;
736 
737 	if (alt_rssi >= antcomb->low_rssi_thresh) {
738 		antcomb->ant_ratio = ATH_ANT_DIV_COMB_ALT_ANT_RATIO;
739 		antcomb->ant_ratio2 = ATH_ANT_DIV_COMB_ALT_ANT_RATIO2;
740 	} else {
741 		antcomb->ant_ratio = ATH_ANT_DIV_COMB_ALT_ANT_RATIO_LOW_RSSI;
742 		antcomb->ant_ratio2 = ATH_ANT_DIV_COMB_ALT_ANT_RATIO2_LOW_RSSI;
743 	}
744 
745 	/* Record packet only when both main_rssi and  alt_rssi is positive */
746 	if (main_rssi > 0 && alt_rssi > 0) {
747 		antcomb->total_pkt_count++;
748 		antcomb->main_total_rssi += main_rssi;
749 		antcomb->alt_total_rssi  += alt_rssi;
750 
751 		if (main_ant_conf == rx_ant_conf)
752 			antcomb->main_recv_cnt++;
753 		else
754 			antcomb->alt_recv_cnt++;
755 	}
756 
757 	if (main_ant_conf == rx_ant_conf) {
758 		ANT_STAT_INC(sc, ANT_MAIN, recv_cnt);
759 		ANT_LNA_INC(sc, ANT_MAIN, rx_ant_conf);
760 	} else {
761 		ANT_STAT_INC(sc, ANT_ALT, recv_cnt);
762 		ANT_LNA_INC(sc, ANT_ALT, rx_ant_conf);
763 	}
764 
765 	/* Short scan check */
766 	short_scan = ath_ant_short_scan_check(antcomb);
767 
768 	if (((antcomb->total_pkt_count < ATH_ANT_DIV_COMB_MAX_PKTCOUNT) ||
769 	     rs->rs_moreaggr) && !short_scan)
770 		return;
771 
772 	if (antcomb->total_pkt_count) {
773 		alt_ratio = ((antcomb->alt_recv_cnt * 100) /
774 			     antcomb->total_pkt_count);
775 		main_rssi_avg = (antcomb->main_total_rssi /
776 				 antcomb->total_pkt_count);
777 		alt_rssi_avg = (antcomb->alt_total_rssi /
778 				 antcomb->total_pkt_count);
779 	}
780 
781 	ath9k_hw_antdiv_comb_conf_get(sc->sc_ah, &div_ant_conf);
782 	curr_alt_set = div_ant_conf.alt_lna_conf;
783 	curr_main_set = div_ant_conf.main_lna_conf;
784 	antcomb->count++;
785 
786 	if (antcomb->count == ATH_ANT_DIV_COMB_MAX_COUNT) {
787 		if (alt_ratio > antcomb->ant_ratio) {
788 			ath_lnaconf_alt_good_scan(antcomb, div_ant_conf,
789 						  main_rssi_avg);
790 			antcomb->alt_good = true;
791 		} else {
792 			antcomb->alt_good = false;
793 		}
794 
795 		antcomb->count = 0;
796 		antcomb->scan = true;
797 		antcomb->scan_not_start = true;
798 	}
799 
800 	if (!antcomb->scan) {
801 		ret = ath_ant_try_switch(&div_ant_conf, antcomb, alt_ratio,
802 					 alt_rssi_avg, main_rssi_avg,
803 					 curr_main_set, curr_alt_set);
804 		if (ret)
805 			goto div_comb_done;
806 	}
807 
808 	if (!antcomb->scan &&
809 	    (alt_rssi_avg < (main_rssi_avg + div_ant_conf.lna1_lna2_delta)))
810 		goto div_comb_done;
811 
812 	if (!antcomb->scan_not_start) {
813 		ath_ant_try_scan(antcomb, &div_ant_conf, curr_alt_set,
814 				 alt_rssi_avg, main_rssi_avg);
815 	} else {
816 		if (!antcomb->alt_good) {
817 			antcomb->scan_not_start = false;
818 			/* Set alt to another LNA */
819 			if (curr_main_set == ATH_ANT_DIV_COMB_LNA2) {
820 				div_ant_conf.main_lna_conf =
821 					ATH_ANT_DIV_COMB_LNA2;
822 				div_ant_conf.alt_lna_conf =
823 					ATH_ANT_DIV_COMB_LNA1;
824 			} else if (curr_main_set == ATH_ANT_DIV_COMB_LNA1) {
825 				div_ant_conf.main_lna_conf =
826 					ATH_ANT_DIV_COMB_LNA1;
827 				div_ant_conf.alt_lna_conf =
828 					ATH_ANT_DIV_COMB_LNA2;
829 			}
830 			goto div_comb_done;
831 		}
832 		ath_select_ant_div_from_quick_scan(antcomb, &div_ant_conf,
833 						   main_rssi_avg, alt_rssi_avg,
834 						   alt_ratio);
835 		antcomb->quick_scan_cnt++;
836 	}
837 
838 div_comb_done:
839 	ath_ant_div_conf_fast_divbias(&div_ant_conf, antcomb, alt_ratio);
840 	ath9k_hw_antdiv_comb_conf_set(sc->sc_ah, &div_ant_conf);
841 	ath9k_debug_stat_ant(sc, &div_ant_conf, main_rssi_avg, alt_rssi_avg);
842 
843 	antcomb->scan_start_time = jiffies;
844 	antcomb->total_pkt_count = 0;
845 	antcomb->main_total_rssi = 0;
846 	antcomb->alt_total_rssi = 0;
847 	antcomb->main_recv_cnt = 0;
848 	antcomb->alt_recv_cnt = 0;
849 }
850