2 * Copyright (c) 2012 Qualcomm Atheros, Inc.
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.
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.
19 static inline bool ath_is_alt_ant_ratio_better(int alt_ratio, int maxdelta,
20 int mindelta, int main_rssi_avg,
21 int alt_rssi_avg, int pkt_count)
23 return (((alt_ratio >= ATH_ANT_DIV_COMB_ALT_ANT_RATIO2) &&
24 (alt_rssi_avg > main_rssi_avg + maxdelta)) ||
25 (alt_rssi_avg > main_rssi_avg + mindelta)) && (pkt_count > 50);
28 static inline bool ath_ant_div_comb_alt_check(struct ath_hw_antcomb_conf *conf,
29 int alt_ratio, int alt_rssi_avg,
32 bool result, set1, set2;
34 result = set1 = set2 = false;
36 if (conf->main_lna_conf == ATH_ANT_DIV_COMB_LNA2 &&
37 conf->alt_lna_conf == ATH_ANT_DIV_COMB_LNA1)
40 if (conf->main_lna_conf == ATH_ANT_DIV_COMB_LNA1 &&
41 conf->alt_lna_conf == ATH_ANT_DIV_COMB_LNA2)
44 switch (conf->div_group) {
46 if (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO)
54 if ((set1 && (alt_rssi_avg >= (main_rssi_avg - 5))) ||
55 (set2 && (alt_rssi_avg >= (main_rssi_avg - 2))))
63 if ((set1 && (alt_rssi_avg >= (main_rssi_avg - 3))) ||
64 (set2 && (alt_rssi_avg >= (main_rssi_avg + 3))))
73 static void ath_lnaconf_alt_good_scan(struct ath_ant_comb *antcomb,
74 struct ath_hw_antcomb_conf ant_conf,
77 antcomb->quick_scan_cnt = 0;
79 if (ant_conf.main_lna_conf == ATH_ANT_DIV_COMB_LNA2)
80 antcomb->rssi_lna2 = main_rssi_avg;
81 else if (ant_conf.main_lna_conf == ATH_ANT_DIV_COMB_LNA1)
82 antcomb->rssi_lna1 = main_rssi_avg;
84 switch ((ant_conf.main_lna_conf << 4) | ant_conf.alt_lna_conf) {
85 case 0x10: /* LNA2 A-B */
86 antcomb->main_conf = ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
87 antcomb->first_quick_scan_conf =
88 ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
89 antcomb->second_quick_scan_conf = ATH_ANT_DIV_COMB_LNA1;
91 case 0x20: /* LNA1 A-B */
92 antcomb->main_conf = ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
93 antcomb->first_quick_scan_conf =
94 ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
95 antcomb->second_quick_scan_conf = ATH_ANT_DIV_COMB_LNA2;
97 case 0x21: /* LNA1 LNA2 */
98 antcomb->main_conf = ATH_ANT_DIV_COMB_LNA2;
99 antcomb->first_quick_scan_conf =
100 ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
101 antcomb->second_quick_scan_conf =
102 ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
104 case 0x12: /* LNA2 LNA1 */
105 antcomb->main_conf = ATH_ANT_DIV_COMB_LNA1;
106 antcomb->first_quick_scan_conf =
107 ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
108 antcomb->second_quick_scan_conf =
109 ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
111 case 0x13: /* LNA2 A+B */
112 antcomb->main_conf = ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
113 antcomb->first_quick_scan_conf =
114 ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
115 antcomb->second_quick_scan_conf = ATH_ANT_DIV_COMB_LNA1;
117 case 0x23: /* LNA1 A+B */
118 antcomb->main_conf = ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
119 antcomb->first_quick_scan_conf =
120 ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
121 antcomb->second_quick_scan_conf = ATH_ANT_DIV_COMB_LNA2;
128 static void ath_select_ant_div_from_quick_scan(struct ath_ant_comb *antcomb,
129 struct ath_hw_antcomb_conf *div_ant_conf,
130 int main_rssi_avg, int alt_rssi_avg,
134 switch (antcomb->quick_scan_cnt) {
136 /* set alt to main, and alt to first conf */
137 div_ant_conf->main_lna_conf = antcomb->main_conf;
138 div_ant_conf->alt_lna_conf = antcomb->first_quick_scan_conf;
141 /* set alt to main, and alt to first conf */
142 div_ant_conf->main_lna_conf = antcomb->main_conf;
143 div_ant_conf->alt_lna_conf = antcomb->second_quick_scan_conf;
144 antcomb->rssi_first = main_rssi_avg;
145 antcomb->rssi_second = alt_rssi_avg;
147 if (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA1) {
149 if (ath_is_alt_ant_ratio_better(alt_ratio,
150 ATH_ANT_DIV_COMB_LNA1_DELTA_HI,
151 ATH_ANT_DIV_COMB_LNA1_DELTA_LOW,
152 main_rssi_avg, alt_rssi_avg,
153 antcomb->total_pkt_count))
154 antcomb->first_ratio = true;
156 antcomb->first_ratio = false;
157 } else if (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA2) {
158 if (ath_is_alt_ant_ratio_better(alt_ratio,
159 ATH_ANT_DIV_COMB_LNA1_DELTA_MID,
160 ATH_ANT_DIV_COMB_LNA1_DELTA_LOW,
161 main_rssi_avg, alt_rssi_avg,
162 antcomb->total_pkt_count))
163 antcomb->first_ratio = true;
165 antcomb->first_ratio = false;
167 if ((((alt_ratio >= ATH_ANT_DIV_COMB_ALT_ANT_RATIO2) &&
168 (alt_rssi_avg > main_rssi_avg +
169 ATH_ANT_DIV_COMB_LNA1_DELTA_HI)) ||
170 (alt_rssi_avg > main_rssi_avg)) &&
171 (antcomb->total_pkt_count > 50))
172 antcomb->first_ratio = true;
174 antcomb->first_ratio = false;
178 antcomb->alt_good = false;
179 antcomb->scan_not_start = false;
180 antcomb->scan = false;
181 antcomb->rssi_first = main_rssi_avg;
182 antcomb->rssi_third = alt_rssi_avg;
184 if (antcomb->second_quick_scan_conf == ATH_ANT_DIV_COMB_LNA1)
185 antcomb->rssi_lna1 = alt_rssi_avg;
186 else if (antcomb->second_quick_scan_conf ==
187 ATH_ANT_DIV_COMB_LNA2)
188 antcomb->rssi_lna2 = alt_rssi_avg;
189 else if (antcomb->second_quick_scan_conf ==
190 ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2) {
191 if (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA2)
192 antcomb->rssi_lna2 = main_rssi_avg;
193 else if (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA1)
194 antcomb->rssi_lna1 = main_rssi_avg;
197 if (antcomb->rssi_lna2 > antcomb->rssi_lna1 +
198 ATH_ANT_DIV_COMB_LNA1_LNA2_SWITCH_DELTA)
199 div_ant_conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA2;
201 div_ant_conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA1;
203 if (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA1) {
204 if (ath_is_alt_ant_ratio_better(alt_ratio,
205 ATH_ANT_DIV_COMB_LNA1_DELTA_HI,
206 ATH_ANT_DIV_COMB_LNA1_DELTA_LOW,
207 main_rssi_avg, alt_rssi_avg,
208 antcomb->total_pkt_count))
209 antcomb->second_ratio = true;
211 antcomb->second_ratio = false;
212 } else if (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA2) {
213 if (ath_is_alt_ant_ratio_better(alt_ratio,
214 ATH_ANT_DIV_COMB_LNA1_DELTA_MID,
215 ATH_ANT_DIV_COMB_LNA1_DELTA_LOW,
216 main_rssi_avg, alt_rssi_avg,
217 antcomb->total_pkt_count))
218 antcomb->second_ratio = true;
220 antcomb->second_ratio = false;
222 if ((((alt_ratio >= ATH_ANT_DIV_COMB_ALT_ANT_RATIO2) &&
223 (alt_rssi_avg > main_rssi_avg +
224 ATH_ANT_DIV_COMB_LNA1_DELTA_HI)) ||
225 (alt_rssi_avg > main_rssi_avg)) &&
226 (antcomb->total_pkt_count > 50))
227 antcomb->second_ratio = true;
229 antcomb->second_ratio = false;
232 /* set alt to the conf with maximun ratio */
233 if (antcomb->first_ratio && antcomb->second_ratio) {
234 if (antcomb->rssi_second > antcomb->rssi_third) {
236 if ((antcomb->first_quick_scan_conf ==
237 ATH_ANT_DIV_COMB_LNA1) ||
238 (antcomb->first_quick_scan_conf ==
239 ATH_ANT_DIV_COMB_LNA2))
240 /* Set alt LNA1 or LNA2*/
241 if (div_ant_conf->main_lna_conf ==
242 ATH_ANT_DIV_COMB_LNA2)
243 div_ant_conf->alt_lna_conf =
244 ATH_ANT_DIV_COMB_LNA1;
246 div_ant_conf->alt_lna_conf =
247 ATH_ANT_DIV_COMB_LNA2;
249 /* Set alt to A+B or A-B */
250 div_ant_conf->alt_lna_conf =
251 antcomb->first_quick_scan_conf;
252 } else if ((antcomb->second_quick_scan_conf ==
253 ATH_ANT_DIV_COMB_LNA1) ||
254 (antcomb->second_quick_scan_conf ==
255 ATH_ANT_DIV_COMB_LNA2)) {
256 /* Set alt LNA1 or LNA2 */
257 if (div_ant_conf->main_lna_conf ==
258 ATH_ANT_DIV_COMB_LNA2)
259 div_ant_conf->alt_lna_conf =
260 ATH_ANT_DIV_COMB_LNA1;
262 div_ant_conf->alt_lna_conf =
263 ATH_ANT_DIV_COMB_LNA2;
265 /* Set alt to A+B or A-B */
266 div_ant_conf->alt_lna_conf =
267 antcomb->second_quick_scan_conf;
269 } else if (antcomb->first_ratio) {
271 if ((antcomb->first_quick_scan_conf ==
272 ATH_ANT_DIV_COMB_LNA1) ||
273 (antcomb->first_quick_scan_conf ==
274 ATH_ANT_DIV_COMB_LNA2))
275 /* Set alt LNA1 or LNA2 */
276 if (div_ant_conf->main_lna_conf ==
277 ATH_ANT_DIV_COMB_LNA2)
278 div_ant_conf->alt_lna_conf =
279 ATH_ANT_DIV_COMB_LNA1;
281 div_ant_conf->alt_lna_conf =
282 ATH_ANT_DIV_COMB_LNA2;
284 /* Set alt to A+B or A-B */
285 div_ant_conf->alt_lna_conf =
286 antcomb->first_quick_scan_conf;
287 } else if (antcomb->second_ratio) {
289 if ((antcomb->second_quick_scan_conf ==
290 ATH_ANT_DIV_COMB_LNA1) ||
291 (antcomb->second_quick_scan_conf ==
292 ATH_ANT_DIV_COMB_LNA2))
293 /* Set alt LNA1 or LNA2 */
294 if (div_ant_conf->main_lna_conf ==
295 ATH_ANT_DIV_COMB_LNA2)
296 div_ant_conf->alt_lna_conf =
297 ATH_ANT_DIV_COMB_LNA1;
299 div_ant_conf->alt_lna_conf =
300 ATH_ANT_DIV_COMB_LNA2;
302 /* Set alt to A+B or A-B */
303 div_ant_conf->alt_lna_conf =
304 antcomb->second_quick_scan_conf;
306 /* main is largest */
307 if ((antcomb->main_conf == ATH_ANT_DIV_COMB_LNA1) ||
308 (antcomb->main_conf == ATH_ANT_DIV_COMB_LNA2))
309 /* Set alt LNA1 or LNA2 */
310 if (div_ant_conf->main_lna_conf ==
311 ATH_ANT_DIV_COMB_LNA2)
312 div_ant_conf->alt_lna_conf =
313 ATH_ANT_DIV_COMB_LNA1;
315 div_ant_conf->alt_lna_conf =
316 ATH_ANT_DIV_COMB_LNA2;
318 /* Set alt to A+B or A-B */
319 div_ant_conf->alt_lna_conf = antcomb->main_conf;
327 static void ath_ant_div_conf_fast_divbias(struct ath_hw_antcomb_conf *ant_conf,
328 struct ath_ant_comb *antcomb,
331 ant_conf->main_gaintb = 0;
332 ant_conf->alt_gaintb = 0;
334 if (ant_conf->div_group == 0) {
335 /* Adjust the fast_div_bias based on main and alt lna conf */
336 switch ((ant_conf->main_lna_conf << 4) |
337 ant_conf->alt_lna_conf) {
338 case 0x01: /* A-B LNA2 */
339 ant_conf->fast_div_bias = 0x3b;
341 case 0x02: /* A-B LNA1 */
342 ant_conf->fast_div_bias = 0x3d;
344 case 0x03: /* A-B A+B */
345 ant_conf->fast_div_bias = 0x1;
347 case 0x10: /* LNA2 A-B */
348 ant_conf->fast_div_bias = 0x7;
350 case 0x12: /* LNA2 LNA1 */
351 ant_conf->fast_div_bias = 0x2;
353 case 0x13: /* LNA2 A+B */
354 ant_conf->fast_div_bias = 0x7;
356 case 0x20: /* LNA1 A-B */
357 ant_conf->fast_div_bias = 0x6;
359 case 0x21: /* LNA1 LNA2 */
360 ant_conf->fast_div_bias = 0x0;
362 case 0x23: /* LNA1 A+B */
363 ant_conf->fast_div_bias = 0x6;
365 case 0x30: /* A+B A-B */
366 ant_conf->fast_div_bias = 0x1;
368 case 0x31: /* A+B LNA2 */
369 ant_conf->fast_div_bias = 0x3b;
371 case 0x32: /* A+B LNA1 */
372 ant_conf->fast_div_bias = 0x3d;
377 } else if (ant_conf->div_group == 1) {
378 /* Adjust the fast_div_bias based on main and alt_lna_conf */
379 switch ((ant_conf->main_lna_conf << 4) |
380 ant_conf->alt_lna_conf) {
381 case 0x01: /* A-B LNA2 */
382 ant_conf->fast_div_bias = 0x1;
384 case 0x02: /* A-B LNA1 */
385 ant_conf->fast_div_bias = 0x1;
387 case 0x03: /* A-B A+B */
388 ant_conf->fast_div_bias = 0x1;
390 case 0x10: /* LNA2 A-B */
391 if (!(antcomb->scan) &&
392 (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO))
393 ant_conf->fast_div_bias = 0x3f;
395 ant_conf->fast_div_bias = 0x1;
397 case 0x12: /* LNA2 LNA1 */
398 ant_conf->fast_div_bias = 0x1;
400 case 0x13: /* LNA2 A+B */
401 if (!(antcomb->scan) &&
402 (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO))
403 ant_conf->fast_div_bias = 0x3f;
405 ant_conf->fast_div_bias = 0x1;
407 case 0x20: /* LNA1 A-B */
408 if (!(antcomb->scan) &&
409 (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO))
410 ant_conf->fast_div_bias = 0x3f;
412 ant_conf->fast_div_bias = 0x1;
414 case 0x21: /* LNA1 LNA2 */
415 ant_conf->fast_div_bias = 0x1;
417 case 0x23: /* LNA1 A+B */
418 if (!(antcomb->scan) &&
419 (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO))
420 ant_conf->fast_div_bias = 0x3f;
422 ant_conf->fast_div_bias = 0x1;
424 case 0x30: /* A+B A-B */
425 ant_conf->fast_div_bias = 0x1;
427 case 0x31: /* A+B LNA2 */
428 ant_conf->fast_div_bias = 0x1;
430 case 0x32: /* A+B LNA1 */
431 ant_conf->fast_div_bias = 0x1;
436 } else if (ant_conf->div_group == 2) {
437 /* Adjust the fast_div_bias based on main and alt_lna_conf */
438 switch ((ant_conf->main_lna_conf << 4) |
439 ant_conf->alt_lna_conf) {
440 case 0x01: /* A-B LNA2 */
441 ant_conf->fast_div_bias = 0x1;
443 case 0x02: /* A-B LNA1 */
444 ant_conf->fast_div_bias = 0x1;
446 case 0x03: /* A-B A+B */
447 ant_conf->fast_div_bias = 0x1;
449 case 0x10: /* LNA2 A-B */
450 if (!(antcomb->scan) &&
451 (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO))
452 ant_conf->fast_div_bias = 0x1;
454 ant_conf->fast_div_bias = 0x2;
456 case 0x12: /* LNA2 LNA1 */
457 ant_conf->fast_div_bias = 0x1;
459 case 0x13: /* LNA2 A+B */
460 if (!(antcomb->scan) &&
461 (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO))
462 ant_conf->fast_div_bias = 0x1;
464 ant_conf->fast_div_bias = 0x2;
466 case 0x20: /* LNA1 A-B */
467 if (!(antcomb->scan) &&
468 (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO))
469 ant_conf->fast_div_bias = 0x1;
471 ant_conf->fast_div_bias = 0x2;
473 case 0x21: /* LNA1 LNA2 */
474 ant_conf->fast_div_bias = 0x1;
476 case 0x23: /* LNA1 A+B */
477 if (!(antcomb->scan) &&
478 (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO))
479 ant_conf->fast_div_bias = 0x1;
481 ant_conf->fast_div_bias = 0x2;
483 case 0x30: /* A+B A-B */
484 ant_conf->fast_div_bias = 0x1;
486 case 0x31: /* A+B LNA2 */
487 ant_conf->fast_div_bias = 0x1;
489 case 0x32: /* A+B LNA1 */
490 ant_conf->fast_div_bias = 0x1;
495 } else if (ant_conf->div_group == 3) {
496 switch ((ant_conf->main_lna_conf << 4) |
497 ant_conf->alt_lna_conf) {
498 case 0x01: /* A-B LNA2 */
499 ant_conf->fast_div_bias = 0x1;
501 case 0x02: /* A-B LNA1 */
502 ant_conf->fast_div_bias = 0x39;
504 case 0x03: /* A-B A+B */
505 ant_conf->fast_div_bias = 0x1;
507 case 0x10: /* LNA2 A-B */
508 if ((antcomb->scan == 0) &&
509 (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO)) {
510 ant_conf->fast_div_bias = 0x3f;
512 ant_conf->fast_div_bias = 0x1;
515 case 0x12: /* LNA2 LNA1 */
516 ant_conf->fast_div_bias = 0x39;
518 case 0x13: /* LNA2 A+B */
519 if ((antcomb->scan == 0) &&
520 (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO)) {
521 ant_conf->fast_div_bias = 0x3f;
523 ant_conf->fast_div_bias = 0x1;
526 case 0x20: /* LNA1 A-B */
527 if ((antcomb->scan == 0) &&
528 (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO)) {
529 ant_conf->fast_div_bias = 0x3f;
531 ant_conf->fast_div_bias = 0x4;
534 case 0x21: /* LNA1 LNA2 */
535 ant_conf->fast_div_bias = 0x6;
537 case 0x23: /* LNA1 A+B */
538 if ((antcomb->scan == 0) &&
539 (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO)) {
540 ant_conf->fast_div_bias = 0x3f;
542 ant_conf->fast_div_bias = 0x6;
545 case 0x30: /* A+B A-B */
546 ant_conf->fast_div_bias = 0x1;
548 case 0x31: /* A+B LNA2 */
549 ant_conf->fast_div_bias = 0x6;
551 case 0x32: /* A+B LNA1 */
552 ant_conf->fast_div_bias = 0x1;
560 static bool ath_ant_try_switch(struct ath_hw_antcomb_conf *div_ant_conf,
561 int alt_ratio, int alt_rssi_avg,
562 int main_rssi_avg, int curr_main_set,
567 if (ath_ant_div_comb_alt_check(div_ant_conf, alt_ratio,
568 alt_rssi_avg, main_rssi_avg)) {
569 if (curr_alt_set == ATH_ANT_DIV_COMB_LNA2) {
571 * Switch main and alt LNA.
573 div_ant_conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA2;
574 div_ant_conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1;
575 } else if (curr_alt_set == ATH_ANT_DIV_COMB_LNA1) {
576 div_ant_conf->main_lna_conf = ATH_ANT_DIV_COMB_LNA1;
577 div_ant_conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA2;
581 } else if ((curr_alt_set != ATH_ANT_DIV_COMB_LNA1) &&
582 (curr_alt_set != ATH_ANT_DIV_COMB_LNA2)) {
584 Set alt to another LNA.
586 if (curr_main_set == ATH_ANT_DIV_COMB_LNA2)
587 div_ant_conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA1;
588 else if (curr_main_set == ATH_ANT_DIV_COMB_LNA1)
589 div_ant_conf->alt_lna_conf = ATH_ANT_DIV_COMB_LNA2;
597 static bool ath_ant_short_scan_check(struct ath_ant_comb *antcomb)
601 if (!antcomb->scan || !antcomb->alt_good)
604 if (time_after(jiffies, antcomb->scan_start_time +
605 msecs_to_jiffies(ATH_ANT_DIV_COMB_SHORT_SCAN_INTR)))
608 if (antcomb->total_pkt_count == ATH_ANT_DIV_COMB_SHORT_SCAN_PKTCOUNT) {
609 alt_ratio = ((antcomb->alt_recv_cnt * 100) /
610 antcomb->total_pkt_count);
611 if (alt_ratio < ATH_ANT_DIV_COMB_ALT_ANT_RATIO)
618 void ath_ant_comb_scan(struct ath_softc *sc, struct ath_rx_status *rs)
620 struct ath_hw_antcomb_conf div_ant_conf;
621 struct ath_ant_comb *antcomb = &sc->ant_comb;
622 int alt_ratio = 0, alt_rssi_avg = 0, main_rssi_avg = 0, curr_alt_set;
624 int main_rssi = rs->rs_rssi_ctl0;
625 int alt_rssi = rs->rs_rssi_ctl1;
626 int rx_ant_conf, main_ant_conf;
627 bool short_scan = false, ret;
629 rx_ant_conf = (rs->rs_rssi_ctl2 >> ATH_ANT_RX_CURRENT_SHIFT) &
631 main_ant_conf = (rs->rs_rssi_ctl2 >> ATH_ANT_RX_MAIN_SHIFT) &
634 /* Record packet only when both main_rssi and alt_rssi is positive */
635 if (main_rssi > 0 && alt_rssi > 0) {
636 antcomb->total_pkt_count++;
637 antcomb->main_total_rssi += main_rssi;
638 antcomb->alt_total_rssi += alt_rssi;
640 if (main_ant_conf == rx_ant_conf) {
641 antcomb->main_recv_cnt++;
642 ANT_STAT_INC(ANT_MAIN, recv_cnt);
643 ANT_LNA_INC(ANT_MAIN, rx_ant_conf);
645 antcomb->alt_recv_cnt++;
646 ANT_STAT_INC(ANT_ALT, recv_cnt);
647 ANT_LNA_INC(ANT_ALT, rx_ant_conf);
651 /* Short scan check */
652 short_scan = ath_ant_short_scan_check(antcomb);
654 if (((antcomb->total_pkt_count < ATH_ANT_DIV_COMB_MAX_PKTCOUNT) ||
655 rs->rs_moreaggr) && !short_scan)
658 if (antcomb->total_pkt_count) {
659 alt_ratio = ((antcomb->alt_recv_cnt * 100) /
660 antcomb->total_pkt_count);
661 main_rssi_avg = (antcomb->main_total_rssi /
662 antcomb->total_pkt_count);
663 alt_rssi_avg = (antcomb->alt_total_rssi /
664 antcomb->total_pkt_count);
667 ath9k_hw_antdiv_comb_conf_get(sc->sc_ah, &div_ant_conf);
668 curr_alt_set = div_ant_conf.alt_lna_conf;
669 curr_main_set = div_ant_conf.main_lna_conf;
672 if (antcomb->count == ATH_ANT_DIV_COMB_MAX_COUNT) {
673 if (alt_ratio > ATH_ANT_DIV_COMB_ALT_ANT_RATIO) {
674 ath_lnaconf_alt_good_scan(antcomb, div_ant_conf,
676 antcomb->alt_good = true;
678 antcomb->alt_good = false;
682 antcomb->scan = true;
683 antcomb->scan_not_start = true;
686 if (!antcomb->scan) {
687 ret = ath_ant_try_switch(&div_ant_conf, alt_ratio,
688 alt_rssi_avg, main_rssi_avg,
689 curr_main_set, curr_alt_set);
694 if (!antcomb->scan &&
695 (alt_rssi_avg < (main_rssi_avg + div_ant_conf.lna1_lna2_delta)))
698 if (!antcomb->scan_not_start) {
699 switch (curr_alt_set) {
700 case ATH_ANT_DIV_COMB_LNA2:
701 antcomb->rssi_lna2 = alt_rssi_avg;
702 antcomb->rssi_lna1 = main_rssi_avg;
703 antcomb->scan = true;
705 div_ant_conf.main_lna_conf =
706 ATH_ANT_DIV_COMB_LNA1;
707 div_ant_conf.alt_lna_conf =
708 ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
710 case ATH_ANT_DIV_COMB_LNA1:
711 antcomb->rssi_lna1 = alt_rssi_avg;
712 antcomb->rssi_lna2 = main_rssi_avg;
713 antcomb->scan = true;
715 div_ant_conf.main_lna_conf = ATH_ANT_DIV_COMB_LNA2;
716 div_ant_conf.alt_lna_conf =
717 ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
719 case ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2:
720 antcomb->rssi_add = alt_rssi_avg;
721 antcomb->scan = true;
723 div_ant_conf.alt_lna_conf =
724 ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
726 case ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2:
727 antcomb->rssi_sub = alt_rssi_avg;
728 antcomb->scan = false;
729 if (antcomb->rssi_lna2 >
730 (antcomb->rssi_lna1 +
731 ATH_ANT_DIV_COMB_LNA1_LNA2_SWITCH_DELTA)) {
732 /* use LNA2 as main LNA */
733 if ((antcomb->rssi_add > antcomb->rssi_lna1) &&
734 (antcomb->rssi_add > antcomb->rssi_sub)) {
736 div_ant_conf.main_lna_conf =
737 ATH_ANT_DIV_COMB_LNA2;
738 div_ant_conf.alt_lna_conf =
739 ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
740 } else if (antcomb->rssi_sub >
741 antcomb->rssi_lna1) {
743 div_ant_conf.main_lna_conf =
744 ATH_ANT_DIV_COMB_LNA2;
745 div_ant_conf.alt_lna_conf =
746 ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
749 div_ant_conf.main_lna_conf =
750 ATH_ANT_DIV_COMB_LNA2;
751 div_ant_conf.alt_lna_conf =
752 ATH_ANT_DIV_COMB_LNA1;
755 /* use LNA1 as main LNA */
756 if ((antcomb->rssi_add > antcomb->rssi_lna2) &&
757 (antcomb->rssi_add > antcomb->rssi_sub)) {
759 div_ant_conf.main_lna_conf =
760 ATH_ANT_DIV_COMB_LNA1;
761 div_ant_conf.alt_lna_conf =
762 ATH_ANT_DIV_COMB_LNA1_PLUS_LNA2;
763 } else if (antcomb->rssi_sub >
764 antcomb->rssi_lna1) {
766 div_ant_conf.main_lna_conf =
767 ATH_ANT_DIV_COMB_LNA1;
768 div_ant_conf.alt_lna_conf =
769 ATH_ANT_DIV_COMB_LNA1_MINUS_LNA2;
772 div_ant_conf.main_lna_conf =
773 ATH_ANT_DIV_COMB_LNA1;
774 div_ant_conf.alt_lna_conf =
775 ATH_ANT_DIV_COMB_LNA2;
783 if (!antcomb->alt_good) {
784 antcomb->scan_not_start = false;
785 /* Set alt to another LNA */
786 if (curr_main_set == ATH_ANT_DIV_COMB_LNA2) {
787 div_ant_conf.main_lna_conf =
788 ATH_ANT_DIV_COMB_LNA2;
789 div_ant_conf.alt_lna_conf =
790 ATH_ANT_DIV_COMB_LNA1;
791 } else if (curr_main_set == ATH_ANT_DIV_COMB_LNA1) {
792 div_ant_conf.main_lna_conf =
793 ATH_ANT_DIV_COMB_LNA1;
794 div_ant_conf.alt_lna_conf =
795 ATH_ANT_DIV_COMB_LNA2;
799 ath_select_ant_div_from_quick_scan(antcomb, &div_ant_conf,
800 main_rssi_avg, alt_rssi_avg,
802 antcomb->quick_scan_cnt++;
806 ath_ant_div_conf_fast_divbias(&div_ant_conf, antcomb, alt_ratio);
807 ath9k_hw_antdiv_comb_conf_set(sc->sc_ah, &div_ant_conf);
809 antcomb->scan_start_time = jiffies;
810 antcomb->total_pkt_count = 0;
811 antcomb->main_total_rssi = 0;
812 antcomb->alt_total_rssi = 0;
813 antcomb->main_recv_cnt = 0;
814 antcomb->alt_recv_cnt = 0;
817 void ath_ant_comb_update(struct ath_softc *sc)
819 struct ath_hw *ah = sc->sc_ah;
820 struct ath_common *common = ath9k_hw_common(ah);
821 struct ath_hw_antcomb_conf div_ant_conf;
824 ath9k_hw_antdiv_comb_conf_get(ah, &div_ant_conf);
827 lna_conf = ATH_ANT_DIV_COMB_LNA1;
829 lna_conf = ATH_ANT_DIV_COMB_LNA2;
831 div_ant_conf.main_lna_conf = lna_conf;
832 div_ant_conf.alt_lna_conf = lna_conf;
834 ath9k_hw_antdiv_comb_conf_set(ah, &div_ant_conf);
836 if (common->antenna_diversity)
837 ath9k_hw_antctrl_shared_chain_lnadiv(ah, true);