1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/relay.h>
18#include <linux/random.h>
19#include "ath9k.h"
20
21static s8 fix_rssi_inv_only(u8 rssi_val)
22{
23 if (rssi_val == 128)
24 rssi_val = 0;
25 return (s8) rssi_val;
26}
27
28static void ath_debug_send_fft_sample(struct ath_spec_scan_priv *spec_priv,
29 struct fft_sample_tlv *fft_sample_tlv)
30{
31 int length;
32 if (!spec_priv->rfs_chan_spec_scan)
33 return;
34
35 length = __be16_to_cpu(fft_sample_tlv->length) +
36 sizeof(*fft_sample_tlv);
37 relay_write(spec_priv->rfs_chan_spec_scan, fft_sample_tlv, length);
38}
39
40typedef int (ath_cmn_fft_idx_validator) (u8 *sample_end, int bytes_read);
41
42static int
43ath_cmn_max_idx_verify_ht20_fft(u8 *sample_end, int bytes_read)
44{
45 struct ath_ht20_mag_info *mag_info;
46 u8 *sample;
47 u16 max_magnitude;
48 u8 max_index;
49 u8 max_exp;
50
51
52
53
54 if (bytes_read < SPECTRAL_HT20_SAMPLE_LEN - 1)
55 return -1;
56
57 mag_info = (struct ath_ht20_mag_info *) (sample_end -
58 sizeof(struct ath_ht20_mag_info) + 1);
59
60 sample = sample_end - SPECTRAL_HT20_SAMPLE_LEN + 1;
61
62 max_index = spectral_max_index(mag_info->all_bins,
63 SPECTRAL_HT20_NUM_BINS);
64 max_magnitude = spectral_max_magnitude(mag_info->all_bins);
65
66 max_exp = mag_info->max_exp & 0xf;
67
68
69
70
71
72 if (bytes_read < SPECTRAL_HT20_SAMPLE_LEN && max_index < 1)
73 return -1;
74
75 if (sample[max_index] != (max_magnitude >> max_exp))
76 return -1;
77 else
78 return 0;
79}
80
81static int
82ath_cmn_max_idx_verify_ht20_40_fft(u8 *sample_end, int bytes_read)
83{
84 struct ath_ht20_40_mag_info *mag_info;
85 u8 *sample;
86 u16 lower_mag, upper_mag;
87 u8 lower_max_index, upper_max_index;
88 u8 max_exp;
89 int dc_pos = SPECTRAL_HT20_40_NUM_BINS / 2;
90
91
92
93
94 if (bytes_read < SPECTRAL_HT20_40_SAMPLE_LEN - 1)
95 return -1;
96
97 mag_info = (struct ath_ht20_40_mag_info *) (sample_end -
98 sizeof(struct ath_ht20_40_mag_info) + 1);
99
100 sample = sample_end - SPECTRAL_HT20_40_SAMPLE_LEN + 1;
101
102 lower_mag = spectral_max_magnitude(mag_info->lower_bins);
103 lower_max_index = spectral_max_index(mag_info->lower_bins,
104 SPECTRAL_HT20_40_NUM_BINS);
105
106 upper_mag = spectral_max_magnitude(mag_info->upper_bins);
107 upper_max_index = spectral_max_index(mag_info->upper_bins,
108 SPECTRAL_HT20_40_NUM_BINS);
109
110 max_exp = mag_info->max_exp & 0xf;
111
112
113
114
115
116 if (bytes_read < SPECTRAL_HT20_40_SAMPLE_LEN &&
117 ((upper_max_index < 1) || (lower_max_index < 1)))
118 return -1;
119
120
121
122
123 if ((upper_max_index - dc_pos > 0) &&
124 (sample[upper_max_index] == (upper_mag >> max_exp)))
125 upper_max_index -= dc_pos;
126
127 if ((lower_max_index - dc_pos > 0) &&
128 (sample[lower_max_index - dc_pos] == (lower_mag >> max_exp)))
129 lower_max_index -= dc_pos;
130
131 if ((sample[upper_max_index + dc_pos] != (upper_mag >> max_exp)) ||
132 (sample[lower_max_index] != (lower_mag >> max_exp)))
133 return -1;
134 else
135 return 0;
136}
137
138typedef int (ath_cmn_fft_sample_handler) (struct ath_rx_status *rs,
139 struct ath_spec_scan_priv *spec_priv,
140 u8 *sample_buf, u64 tsf, u16 freq, int chan_type);
141
142static int
143ath_cmn_process_ht20_fft(struct ath_rx_status *rs,
144 struct ath_spec_scan_priv *spec_priv,
145 u8 *sample_buf,
146 u64 tsf, u16 freq, int chan_type)
147{
148 struct fft_sample_ht20 fft_sample_20;
149 struct ath_common *common = ath9k_hw_common(spec_priv->ah);
150 struct ath_hw *ah = spec_priv->ah;
151 struct ath_ht20_mag_info *mag_info;
152 struct fft_sample_tlv *tlv;
153 int i = 0;
154 int ret = 0;
155 int dc_pos = SPECTRAL_HT20_NUM_BINS / 2;
156 u16 magnitude, tmp_mag, length;
157 u8 max_index, bitmap_w, max_exp;
158
159 length = sizeof(fft_sample_20) - sizeof(struct fft_sample_tlv);
160 fft_sample_20.tlv.type = ATH_FFT_SAMPLE_HT20;
161 fft_sample_20.tlv.length = __cpu_to_be16(length);
162 fft_sample_20.freq = __cpu_to_be16(freq);
163 fft_sample_20.rssi = fix_rssi_inv_only(rs->rs_rssi_ctl[0]);
164 fft_sample_20.noise = ah->noise;
165
166 mag_info = (struct ath_ht20_mag_info *) (sample_buf +
167 SPECTRAL_HT20_NUM_BINS);
168
169 magnitude = spectral_max_magnitude(mag_info->all_bins);
170 fft_sample_20.max_magnitude = __cpu_to_be16(magnitude);
171
172 max_index = spectral_max_index(mag_info->all_bins,
173 SPECTRAL_HT20_NUM_BINS);
174 fft_sample_20.max_index = max_index;
175
176 bitmap_w = spectral_bitmap_weight(mag_info->all_bins);
177 fft_sample_20.bitmap_weight = bitmap_w;
178
179 max_exp = mag_info->max_exp & 0xf;
180 fft_sample_20.max_exp = max_exp;
181
182 fft_sample_20.tsf = __cpu_to_be64(tsf);
183
184 memcpy(fft_sample_20.data, sample_buf, SPECTRAL_HT20_NUM_BINS);
185
186 ath_dbg(common, SPECTRAL_SCAN, "FFT HT20 frame: max mag 0x%X,"
187 "max_mag_idx %i\n",
188 magnitude >> max_exp,
189 max_index);
190
191 if (fft_sample_20.data[max_index] != (magnitude >> max_exp)) {
192 ath_dbg(common, SPECTRAL_SCAN, "Magnitude mismatch !\n");
193 ret = -1;
194 }
195
196
197
198
199 fft_sample_20.data[dc_pos] = (fft_sample_20.data[dc_pos + 1] +
200 fft_sample_20.data[dc_pos - 1]) / 2;
201
202
203
204
205
206 if (max_index == dc_pos) {
207 tmp_mag = 0;
208 for (i = 0; i < dc_pos; i++) {
209 if (fft_sample_20.data[i] > tmp_mag) {
210 tmp_mag = fft_sample_20.data[i];
211 fft_sample_20.max_index = i;
212 }
213 }
214
215 magnitude = tmp_mag << max_exp;
216 fft_sample_20.max_magnitude = __cpu_to_be16(magnitude);
217
218 ath_dbg(common, SPECTRAL_SCAN,
219 "Calculated new lower max 0x%X at %i\n",
220 tmp_mag, fft_sample_20.max_index);
221 } else
222 for (i = 0; i < SPECTRAL_HT20_NUM_BINS; i++) {
223 if (fft_sample_20.data[i] == (magnitude >> max_exp))
224 ath_dbg(common, SPECTRAL_SCAN,
225 "Got max: 0x%X at index %i\n",
226 fft_sample_20.data[i], i);
227
228 if (fft_sample_20.data[i] > (magnitude >> max_exp)) {
229 ath_dbg(common, SPECTRAL_SCAN,
230 "Got bin %i greater than max: 0x%X\n",
231 i, fft_sample_20.data[i]);
232 ret = -1;
233 }
234 }
235
236 if (ret < 0)
237 return ret;
238
239 tlv = (struct fft_sample_tlv *)&fft_sample_20;
240
241 ath_debug_send_fft_sample(spec_priv, tlv);
242
243 return 0;
244}
245
246static int
247ath_cmn_process_ht20_40_fft(struct ath_rx_status *rs,
248 struct ath_spec_scan_priv *spec_priv,
249 u8 *sample_buf,
250 u64 tsf, u16 freq, int chan_type)
251{
252 struct fft_sample_ht20_40 fft_sample_40;
253 struct ath_common *common = ath9k_hw_common(spec_priv->ah);
254 struct ath_hw *ah = spec_priv->ah;
255 struct ath9k_hw_cal_data *caldata = ah->caldata;
256 struct ath_ht20_40_mag_info *mag_info;
257 struct fft_sample_tlv *tlv;
258 int dc_pos = SPECTRAL_HT20_40_NUM_BINS / 2;
259 int i = 0;
260 int ret = 0;
261 s16 ext_nf;
262 u16 lower_mag, upper_mag, tmp_mag, length;
263 s8 lower_rssi, upper_rssi;
264 u8 lower_max_index, upper_max_index;
265 u8 lower_bitmap_w, upper_bitmap_w, max_exp;
266
267 if (caldata)
268 ext_nf = ath9k_hw_getchan_noise(ah, ah->curchan,
269 caldata->nfCalHist[3].privNF);
270 else
271 ext_nf = ATH_DEFAULT_NOISE_FLOOR;
272
273 length = sizeof(fft_sample_40) - sizeof(struct fft_sample_tlv);
274 fft_sample_40.tlv.type = ATH_FFT_SAMPLE_HT20_40;
275 fft_sample_40.tlv.length = __cpu_to_be16(length);
276 fft_sample_40.freq = __cpu_to_be16(freq);
277 fft_sample_40.channel_type = chan_type;
278
279 if (chan_type == NL80211_CHAN_HT40PLUS) {
280 lower_rssi = fix_rssi_inv_only(rs->rs_rssi_ctl[0]);
281 upper_rssi = fix_rssi_inv_only(rs->rs_rssi_ext[0]);
282
283 fft_sample_40.lower_noise = ah->noise;
284 fft_sample_40.upper_noise = ext_nf;
285 } else {
286 lower_rssi = fix_rssi_inv_only(rs->rs_rssi_ext[0]);
287 upper_rssi = fix_rssi_inv_only(rs->rs_rssi_ctl[0]);
288
289 fft_sample_40.lower_noise = ext_nf;
290 fft_sample_40.upper_noise = ah->noise;
291 }
292
293 fft_sample_40.lower_rssi = lower_rssi;
294 fft_sample_40.upper_rssi = upper_rssi;
295
296 mag_info = (struct ath_ht20_40_mag_info *) (sample_buf +
297 SPECTRAL_HT20_40_NUM_BINS);
298
299 lower_mag = spectral_max_magnitude(mag_info->lower_bins);
300 fft_sample_40.lower_max_magnitude = __cpu_to_be16(lower_mag);
301
302 upper_mag = spectral_max_magnitude(mag_info->upper_bins);
303 fft_sample_40.upper_max_magnitude = __cpu_to_be16(upper_mag);
304
305 lower_max_index = spectral_max_index(mag_info->lower_bins,
306 SPECTRAL_HT20_40_NUM_BINS);
307 fft_sample_40.lower_max_index = lower_max_index;
308
309 upper_max_index = spectral_max_index(mag_info->upper_bins,
310 SPECTRAL_HT20_40_NUM_BINS);
311 fft_sample_40.upper_max_index = upper_max_index;
312
313 lower_bitmap_w = spectral_bitmap_weight(mag_info->lower_bins);
314 fft_sample_40.lower_bitmap_weight = lower_bitmap_w;
315
316 upper_bitmap_w = spectral_bitmap_weight(mag_info->upper_bins);
317 fft_sample_40.upper_bitmap_weight = upper_bitmap_w;
318
319 max_exp = mag_info->max_exp & 0xf;
320 fft_sample_40.max_exp = max_exp;
321
322 fft_sample_40.tsf = __cpu_to_be64(tsf);
323
324 memcpy(fft_sample_40.data, sample_buf, SPECTRAL_HT20_40_NUM_BINS);
325
326 ath_dbg(common, SPECTRAL_SCAN, "FFT HT20/40 frame: lower mag 0x%X,"
327 "lower_mag_idx %i, upper mag 0x%X,"
328 "upper_mag_idx %i\n",
329 lower_mag >> max_exp,
330 lower_max_index,
331 upper_mag >> max_exp,
332 upper_max_index);
333
334
335
336
337 if ((upper_max_index - dc_pos > 0) &&
338 (fft_sample_40.data[upper_max_index] == (upper_mag >> max_exp))) {
339 upper_max_index -= dc_pos;
340 fft_sample_40.upper_max_index = upper_max_index;
341 }
342
343 if ((lower_max_index - dc_pos > 0) &&
344 (fft_sample_40.data[lower_max_index - dc_pos] ==
345 (lower_mag >> max_exp))) {
346 lower_max_index -= dc_pos;
347 fft_sample_40.lower_max_index = lower_max_index;
348 }
349
350
351
352
353 if ((fft_sample_40.data[upper_max_index + dc_pos]
354 != (upper_mag >> max_exp)) ||
355 (fft_sample_40.data[lower_max_index]
356 != (lower_mag >> max_exp))) {
357 ath_dbg(common, SPECTRAL_SCAN, "Magnitude mismatch !\n");
358 ret = -1;
359 }
360
361
362
363
364 fft_sample_40.data[dc_pos] = (fft_sample_40.data[dc_pos + 1] +
365 fft_sample_40.data[dc_pos - 1]) / 2;
366
367
368
369
370
371 if (lower_max_index == dc_pos) {
372 tmp_mag = 0;
373 for (i = 0; i < dc_pos; i++) {
374 if (fft_sample_40.data[i] > tmp_mag) {
375 tmp_mag = fft_sample_40.data[i];
376 fft_sample_40.lower_max_index = i;
377 }
378 }
379
380 lower_mag = tmp_mag << max_exp;
381 fft_sample_40.lower_max_magnitude = __cpu_to_be16(lower_mag);
382
383 ath_dbg(common, SPECTRAL_SCAN,
384 "Calculated new lower max 0x%X at %i\n",
385 tmp_mag, fft_sample_40.lower_max_index);
386 } else
387 for (i = 0; i < dc_pos; i++) {
388 if (fft_sample_40.data[i] == (lower_mag >> max_exp))
389 ath_dbg(common, SPECTRAL_SCAN,
390 "Got lower mag: 0x%X at index %i\n",
391 fft_sample_40.data[i], i);
392
393 if (fft_sample_40.data[i] > (lower_mag >> max_exp)) {
394 ath_dbg(common, SPECTRAL_SCAN,
395 "Got lower bin %i higher than max: 0x%X\n",
396 i, fft_sample_40.data[i]);
397 ret = -1;
398 }
399 }
400
401 if (upper_max_index == dc_pos) {
402 tmp_mag = 0;
403 for (i = dc_pos; i < SPECTRAL_HT20_40_NUM_BINS; i++) {
404 if (fft_sample_40.data[i] > tmp_mag) {
405 tmp_mag = fft_sample_40.data[i];
406 fft_sample_40.upper_max_index = i;
407 }
408 }
409 upper_mag = tmp_mag << max_exp;
410 fft_sample_40.upper_max_magnitude = __cpu_to_be16(upper_mag);
411
412 ath_dbg(common, SPECTRAL_SCAN,
413 "Calculated new upper max 0x%X at %i\n",
414 tmp_mag, i);
415 } else
416 for (i = dc_pos; i < SPECTRAL_HT20_40_NUM_BINS; i++) {
417 if (fft_sample_40.data[i] == (upper_mag >> max_exp))
418 ath_dbg(common, SPECTRAL_SCAN,
419 "Got upper mag: 0x%X at index %i\n",
420 fft_sample_40.data[i], i);
421
422 if (fft_sample_40.data[i] > (upper_mag >> max_exp)) {
423 ath_dbg(common, SPECTRAL_SCAN,
424 "Got upper bin %i higher than max: 0x%X\n",
425 i, fft_sample_40.data[i]);
426
427 ret = -1;
428 }
429 }
430
431 if (ret < 0)
432 return ret;
433
434 tlv = (struct fft_sample_tlv *)&fft_sample_40;
435
436 ath_debug_send_fft_sample(spec_priv, tlv);
437
438 return 0;
439}
440
441static inline void
442ath_cmn_copy_fft_frame(u8 *in, u8 *out, int sample_len, int sample_bytes)
443{
444 switch (sample_bytes - sample_len) {
445 case -1:
446
447 memcpy(&out[1], in,
448 sample_len - 1);
449 break;
450 case 0:
451
452 memcpy(out, in, sample_len);
453 break;
454 case 1:
455
456
457
458 memcpy(&out[1], in, 30);
459 out[31] = in[31];
460 memcpy(&out[32], &in[33],
461 sample_len - 32);
462 break;
463 case 2:
464
465
466
467 memcpy(out, in, 30);
468 out[30] = in[31];
469 memcpy(&out[31], &in[33],
470 sample_len - 31);
471 break;
472 default:
473 break;
474 }
475}
476
477static int
478ath_cmn_is_fft_buf_full(struct ath_spec_scan_priv *spec_priv)
479{
480 int i = 0;
481 int ret = 0;
482 struct rchan *rc = spec_priv->rfs_chan_spec_scan;
483
484 for_each_online_cpu(i)
485 ret += relay_buf_full(*per_cpu_ptr(rc->buf, i));
486
487 i = num_online_cpus();
488
489 if (ret == i)
490 return 1;
491 else
492 return 0;
493}
494
495
496int ath_cmn_process_fft(struct ath_spec_scan_priv *spec_priv, struct ieee80211_hdr *hdr,
497 struct ath_rx_status *rs, u64 tsf)
498{
499 u8 sample_buf[SPECTRAL_SAMPLE_MAX_LEN] = {0};
500 struct ath_hw *ah = spec_priv->ah;
501 struct ath_common *common = ath9k_hw_common(spec_priv->ah);
502 u8 num_bins, *vdata = (u8 *)hdr;
503 struct ath_radar_info *radar_info;
504 int len = rs->rs_datalen;
505 int i;
506 int got_slen = 0;
507 u8 *sample_start;
508 int sample_bytes = 0;
509 int ret = 0;
510 u16 fft_len, sample_len, freq = ah->curchan->chan->center_freq;
511 enum nl80211_channel_type chan_type;
512 ath_cmn_fft_idx_validator *fft_idx_validator;
513 ath_cmn_fft_sample_handler *fft_handler;
514
515
516
517
518
519 if (rs->rs_phyerr != ATH9K_PHYERR_RADAR &&
520 rs->rs_phyerr != ATH9K_PHYERR_FALSE_RADAR_EXT &&
521 rs->rs_phyerr != ATH9K_PHYERR_SPECTRAL)
522 return 0;
523
524
525
526
527 radar_info = ((struct ath_radar_info *)&vdata[len]) - 1;
528 if (!(radar_info->pulse_bw_info & SPECTRAL_SCAN_BITMASK))
529 return 0;
530
531 if (!spec_priv->rfs_chan_spec_scan)
532 return 1;
533
534
535
536
537 ret = ath_cmn_is_fft_buf_full(spec_priv);
538 if (ret == 1) {
539 ath_dbg(common, SPECTRAL_SCAN, "FFT report ignored, no space "
540 "left on output buffers\n");
541 return 1;
542 }
543
544 chan_type = cfg80211_get_chandef_type(&common->hw->conf.chandef);
545 if ((chan_type == NL80211_CHAN_HT40MINUS) ||
546 (chan_type == NL80211_CHAN_HT40PLUS)) {
547 fft_len = SPECTRAL_HT20_40_TOTAL_DATA_LEN;
548 sample_len = SPECTRAL_HT20_40_SAMPLE_LEN;
549 num_bins = SPECTRAL_HT20_40_NUM_BINS;
550 fft_idx_validator = &ath_cmn_max_idx_verify_ht20_40_fft;
551 fft_handler = &ath_cmn_process_ht20_40_fft;
552 } else {
553 fft_len = SPECTRAL_HT20_TOTAL_DATA_LEN;
554 sample_len = SPECTRAL_HT20_SAMPLE_LEN;
555 num_bins = SPECTRAL_HT20_NUM_BINS;
556 fft_idx_validator = ath_cmn_max_idx_verify_ht20_fft;
557 fft_handler = &ath_cmn_process_ht20_fft;
558 }
559
560 ath_dbg(common, SPECTRAL_SCAN, "Got radar dump bw_info: 0x%X,"
561 "len: %i fft_len: %i\n",
562 radar_info->pulse_bw_info,
563 len,
564 fft_len);
565 sample_start = vdata;
566 for (i = 0; i < len - 2; i++) {
567 sample_bytes++;
568
569
570
571
572
573
574
575 if (len <= fft_len + 2) {
576 sample_bytes = len - sizeof(struct ath_radar_info);
577 got_slen = 1;
578 }
579
580
581
582
583
584
585
586
587 if (vdata[i] <= 0x7 && sample_bytes >= sample_len - 1) {
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606 if ((sample_bytes > sample_len + 2) ||
607 ((sample_bytes > sample_len) &&
608 (sample_start[31] != sample_start[32])))
609 break;
610
611
612
613
614
615
616
617 if (!fft_idx_validator(&vdata[i], i)) {
618 ath_dbg(common, SPECTRAL_SCAN,
619 "Found valid fft frame at %i\n", i);
620 got_slen = 1;
621 }
622
623
624 else if ((sample_start[31] == sample_start[32]) &&
625 (sample_bytes >= sample_len) &&
626 (sample_bytes < sample_len + 2) &&
627 (vdata[i + 1] <= 0x7))
628 continue;
629
630
631 else if ((sample_bytes == sample_len - 1) &&
632 (vdata[i + 1] <= 0x7))
633 continue;
634
635 got_slen = 1;
636 }
637
638 if (got_slen) {
639 ath_dbg(common, SPECTRAL_SCAN, "FFT frame len: %i\n",
640 sample_bytes);
641
642
643
644
645 if (sample_bytes != sample_len && len <= fft_len + 2) {
646 ath_cmn_copy_fft_frame(sample_start,
647 sample_buf, sample_len,
648 sample_bytes);
649
650 fft_handler(rs, spec_priv, sample_buf,
651 tsf, freq, chan_type);
652
653 memset(sample_buf, 0, SPECTRAL_SAMPLE_MAX_LEN);
654
655
656
657
658 add_device_randomness(sample_buf, num_bins);
659 }
660
661
662 if (sample_bytes == sample_len) {
663 ret = fft_handler(rs, spec_priv, sample_start,
664 tsf, freq, chan_type);
665
666
667
668
669 add_device_randomness(sample_start, num_bins);
670 }
671
672
673
674
675 if (len <= fft_len + 2)
676 break;
677
678 sample_start = &vdata[i + 1];
679
680
681
682
683
684
685 if (ret == 0) {
686 i += num_bins - 2;
687 sample_bytes = num_bins - 2;
688 }
689 got_slen = 0;
690 }
691 }
692
693 i -= num_bins - 2;
694 if (len - i != sizeof(struct ath_radar_info))
695 ath_dbg(common, SPECTRAL_SCAN, "FFT report truncated"
696 "(bytes left: %i)\n",
697 len - i);
698 return 1;
699}
700EXPORT_SYMBOL(ath_cmn_process_fft);
701
702
703
704
705
706static ssize_t read_file_spec_scan_ctl(struct file *file, char __user *user_buf,
707 size_t count, loff_t *ppos)
708{
709 struct ath_spec_scan_priv *spec_priv = file->private_data;
710 char *mode = "";
711 unsigned int len;
712
713 switch (spec_priv->spectral_mode) {
714 case SPECTRAL_DISABLED:
715 mode = "disable";
716 break;
717 case SPECTRAL_BACKGROUND:
718 mode = "background";
719 break;
720 case SPECTRAL_CHANSCAN:
721 mode = "chanscan";
722 break;
723 case SPECTRAL_MANUAL:
724 mode = "manual";
725 break;
726 }
727 len = strlen(mode);
728 return simple_read_from_buffer(user_buf, count, ppos, mode, len);
729}
730
731void ath9k_cmn_spectral_scan_trigger(struct ath_common *common,
732 struct ath_spec_scan_priv *spec_priv)
733{
734 struct ath_hw *ah = spec_priv->ah;
735 u32 rxfilter;
736
737 if (IS_ENABLED(CONFIG_ATH9K_TX99))
738 return;
739
740 if (!ath9k_hw_ops(ah)->spectral_scan_trigger) {
741 ath_err(common, "spectrum analyzer not implemented on this hardware\n");
742 return;
743 }
744
745 if (!spec_priv->spec_config.enabled)
746 return;
747
748 ath_ps_ops(common)->wakeup(common);
749 rxfilter = ath9k_hw_getrxfilter(ah);
750 ath9k_hw_setrxfilter(ah, rxfilter |
751 ATH9K_RX_FILTER_PHYRADAR |
752 ATH9K_RX_FILTER_PHYERR);
753
754
755
756
757
758
759 ath9k_cmn_spectral_scan_config(common, spec_priv, spec_priv->spectral_mode);
760 ath9k_hw_ops(ah)->spectral_scan_trigger(ah);
761 ath_ps_ops(common)->restore(common);
762}
763EXPORT_SYMBOL(ath9k_cmn_spectral_scan_trigger);
764
765int ath9k_cmn_spectral_scan_config(struct ath_common *common,
766 struct ath_spec_scan_priv *spec_priv,
767 enum spectral_mode spectral_mode)
768{
769 struct ath_hw *ah = spec_priv->ah;
770
771 if (!ath9k_hw_ops(ah)->spectral_scan_trigger) {
772 ath_err(common, "spectrum analyzer not implemented on this hardware\n");
773 return -1;
774 }
775
776 switch (spectral_mode) {
777 case SPECTRAL_DISABLED:
778 spec_priv->spec_config.enabled = 0;
779 break;
780 case SPECTRAL_BACKGROUND:
781
782
783
784 spec_priv->spec_config.endless = 1;
785 spec_priv->spec_config.enabled = 1;
786 break;
787 case SPECTRAL_CHANSCAN:
788 case SPECTRAL_MANUAL:
789 spec_priv->spec_config.endless = 0;
790 spec_priv->spec_config.enabled = 1;
791 break;
792 default:
793 return -1;
794 }
795
796 ath_ps_ops(common)->wakeup(common);
797 ath9k_hw_ops(ah)->spectral_scan_config(ah, &spec_priv->spec_config);
798 ath_ps_ops(common)->restore(common);
799
800 spec_priv->spectral_mode = spectral_mode;
801
802 return 0;
803}
804EXPORT_SYMBOL(ath9k_cmn_spectral_scan_config);
805
806static ssize_t write_file_spec_scan_ctl(struct file *file,
807 const char __user *user_buf,
808 size_t count, loff_t *ppos)
809{
810 struct ath_spec_scan_priv *spec_priv = file->private_data;
811 struct ath_common *common = ath9k_hw_common(spec_priv->ah);
812 char buf[32];
813 ssize_t len;
814
815 if (IS_ENABLED(CONFIG_ATH9K_TX99))
816 return -EOPNOTSUPP;
817
818 len = min(count, sizeof(buf) - 1);
819 if (copy_from_user(buf, user_buf, len))
820 return -EFAULT;
821
822 buf[len] = '\0';
823
824 if (strncmp("trigger", buf, 7) == 0) {
825 ath9k_cmn_spectral_scan_trigger(common, spec_priv);
826 } else if (strncmp("background", buf, 10) == 0) {
827 ath9k_cmn_spectral_scan_config(common, spec_priv, SPECTRAL_BACKGROUND);
828 ath_dbg(common, CONFIG, "spectral scan: background mode enabled\n");
829 } else if (strncmp("chanscan", buf, 8) == 0) {
830 ath9k_cmn_spectral_scan_config(common, spec_priv, SPECTRAL_CHANSCAN);
831 ath_dbg(common, CONFIG, "spectral scan: channel scan mode enabled\n");
832 } else if (strncmp("manual", buf, 6) == 0) {
833 ath9k_cmn_spectral_scan_config(common, spec_priv, SPECTRAL_MANUAL);
834 ath_dbg(common, CONFIG, "spectral scan: manual mode enabled\n");
835 } else if (strncmp("disable", buf, 7) == 0) {
836 ath9k_cmn_spectral_scan_config(common, spec_priv, SPECTRAL_DISABLED);
837 ath_dbg(common, CONFIG, "spectral scan: disabled\n");
838 } else {
839 return -EINVAL;
840 }
841
842 return count;
843}
844
845static const struct file_operations fops_spec_scan_ctl = {
846 .read = read_file_spec_scan_ctl,
847 .write = write_file_spec_scan_ctl,
848 .open = simple_open,
849 .owner = THIS_MODULE,
850 .llseek = default_llseek,
851};
852
853
854
855
856
857static ssize_t read_file_spectral_short_repeat(struct file *file,
858 char __user *user_buf,
859 size_t count, loff_t *ppos)
860{
861 struct ath_spec_scan_priv *spec_priv = file->private_data;
862 char buf[32];
863 unsigned int len;
864
865 len = sprintf(buf, "%d\n", spec_priv->spec_config.short_repeat);
866 return simple_read_from_buffer(user_buf, count, ppos, buf, len);
867}
868
869static ssize_t write_file_spectral_short_repeat(struct file *file,
870 const char __user *user_buf,
871 size_t count, loff_t *ppos)
872{
873 struct ath_spec_scan_priv *spec_priv = file->private_data;
874 unsigned long val;
875 char buf[32];
876 ssize_t len;
877
878 len = min(count, sizeof(buf) - 1);
879 if (copy_from_user(buf, user_buf, len))
880 return -EFAULT;
881
882 buf[len] = '\0';
883 if (kstrtoul(buf, 0, &val))
884 return -EINVAL;
885
886 if (val > 1)
887 return -EINVAL;
888
889 spec_priv->spec_config.short_repeat = val;
890 return count;
891}
892
893static const struct file_operations fops_spectral_short_repeat = {
894 .read = read_file_spectral_short_repeat,
895 .write = write_file_spectral_short_repeat,
896 .open = simple_open,
897 .owner = THIS_MODULE,
898 .llseek = default_llseek,
899};
900
901
902
903
904
905static ssize_t read_file_spectral_count(struct file *file,
906 char __user *user_buf,
907 size_t count, loff_t *ppos)
908{
909 struct ath_spec_scan_priv *spec_priv = file->private_data;
910 char buf[32];
911 unsigned int len;
912
913 len = sprintf(buf, "%d\n", spec_priv->spec_config.count);
914 return simple_read_from_buffer(user_buf, count, ppos, buf, len);
915}
916
917static ssize_t write_file_spectral_count(struct file *file,
918 const char __user *user_buf,
919 size_t count, loff_t *ppos)
920{
921 struct ath_spec_scan_priv *spec_priv = file->private_data;
922 unsigned long val;
923 char buf[32];
924 ssize_t len;
925
926 len = min(count, sizeof(buf) - 1);
927 if (copy_from_user(buf, user_buf, len))
928 return -EFAULT;
929
930 buf[len] = '\0';
931 if (kstrtoul(buf, 0, &val))
932 return -EINVAL;
933
934 if (val > 255)
935 return -EINVAL;
936
937 spec_priv->spec_config.count = val;
938 return count;
939}
940
941static const struct file_operations fops_spectral_count = {
942 .read = read_file_spectral_count,
943 .write = write_file_spectral_count,
944 .open = simple_open,
945 .owner = THIS_MODULE,
946 .llseek = default_llseek,
947};
948
949
950
951
952
953static ssize_t read_file_spectral_period(struct file *file,
954 char __user *user_buf,
955 size_t count, loff_t *ppos)
956{
957 struct ath_spec_scan_priv *spec_priv = file->private_data;
958 char buf[32];
959 unsigned int len;
960
961 len = sprintf(buf, "%d\n", spec_priv->spec_config.period);
962 return simple_read_from_buffer(user_buf, count, ppos, buf, len);
963}
964
965static ssize_t write_file_spectral_period(struct file *file,
966 const char __user *user_buf,
967 size_t count, loff_t *ppos)
968{
969 struct ath_spec_scan_priv *spec_priv = file->private_data;
970 unsigned long val;
971 char buf[32];
972 ssize_t len;
973
974 len = min(count, sizeof(buf) - 1);
975 if (copy_from_user(buf, user_buf, len))
976 return -EFAULT;
977
978 buf[len] = '\0';
979 if (kstrtoul(buf, 0, &val))
980 return -EINVAL;
981
982 if (val > 255)
983 return -EINVAL;
984
985 spec_priv->spec_config.period = val;
986 return count;
987}
988
989static const struct file_operations fops_spectral_period = {
990 .read = read_file_spectral_period,
991 .write = write_file_spectral_period,
992 .open = simple_open,
993 .owner = THIS_MODULE,
994 .llseek = default_llseek,
995};
996
997
998
999
1000
1001static ssize_t read_file_spectral_fft_period(struct file *file,
1002 char __user *user_buf,
1003 size_t count, loff_t *ppos)
1004{
1005 struct ath_spec_scan_priv *spec_priv = file->private_data;
1006 char buf[32];
1007 unsigned int len;
1008
1009 len = sprintf(buf, "%d\n", spec_priv->spec_config.fft_period);
1010 return simple_read_from_buffer(user_buf, count, ppos, buf, len);
1011}
1012
1013static ssize_t write_file_spectral_fft_period(struct file *file,
1014 const char __user *user_buf,
1015 size_t count, loff_t *ppos)
1016{
1017 struct ath_spec_scan_priv *spec_priv = file->private_data;
1018 unsigned long val;
1019 char buf[32];
1020 ssize_t len;
1021
1022 len = min(count, sizeof(buf) - 1);
1023 if (copy_from_user(buf, user_buf, len))
1024 return -EFAULT;
1025
1026 buf[len] = '\0';
1027 if (kstrtoul(buf, 0, &val))
1028 return -EINVAL;
1029
1030 if (val > 15)
1031 return -EINVAL;
1032
1033 spec_priv->spec_config.fft_period = val;
1034 return count;
1035}
1036
1037static const struct file_operations fops_spectral_fft_period = {
1038 .read = read_file_spectral_fft_period,
1039 .write = write_file_spectral_fft_period,
1040 .open = simple_open,
1041 .owner = THIS_MODULE,
1042 .llseek = default_llseek,
1043};
1044
1045
1046
1047
1048
1049static struct dentry *create_buf_file_handler(const char *filename,
1050 struct dentry *parent,
1051 umode_t mode,
1052 struct rchan_buf *buf,
1053 int *is_global)
1054{
1055 struct dentry *buf_file;
1056
1057 buf_file = debugfs_create_file(filename, mode, parent, buf,
1058 &relay_file_operations);
1059 *is_global = 1;
1060 return buf_file;
1061}
1062
1063static int remove_buf_file_handler(struct dentry *dentry)
1064{
1065 debugfs_remove(dentry);
1066
1067 return 0;
1068}
1069
1070static struct rchan_callbacks rfs_spec_scan_cb = {
1071 .create_buf_file = create_buf_file_handler,
1072 .remove_buf_file = remove_buf_file_handler,
1073};
1074
1075
1076
1077
1078
1079void ath9k_cmn_spectral_deinit_debug(struct ath_spec_scan_priv *spec_priv)
1080{
1081 if (spec_priv->rfs_chan_spec_scan) {
1082 relay_close(spec_priv->rfs_chan_spec_scan);
1083 spec_priv->rfs_chan_spec_scan = NULL;
1084 }
1085}
1086EXPORT_SYMBOL(ath9k_cmn_spectral_deinit_debug);
1087
1088void ath9k_cmn_spectral_init_debug(struct ath_spec_scan_priv *spec_priv,
1089 struct dentry *debugfs_phy)
1090{
1091 spec_priv->rfs_chan_spec_scan = relay_open("spectral_scan",
1092 debugfs_phy,
1093 1024, 256, &rfs_spec_scan_cb,
1094 NULL);
1095 if (!spec_priv->rfs_chan_spec_scan)
1096 return;
1097
1098 debugfs_create_file("spectral_scan_ctl",
1099 S_IRUSR | S_IWUSR,
1100 debugfs_phy, spec_priv,
1101 &fops_spec_scan_ctl);
1102 debugfs_create_file("spectral_short_repeat",
1103 S_IRUSR | S_IWUSR,
1104 debugfs_phy, spec_priv,
1105 &fops_spectral_short_repeat);
1106 debugfs_create_file("spectral_count",
1107 S_IRUSR | S_IWUSR,
1108 debugfs_phy, spec_priv,
1109 &fops_spectral_count);
1110 debugfs_create_file("spectral_period",
1111 S_IRUSR | S_IWUSR,
1112 debugfs_phy, spec_priv,
1113 &fops_spectral_period);
1114 debugfs_create_file("spectral_fft_period",
1115 S_IRUSR | S_IWUSR,
1116 debugfs_phy, spec_priv,
1117 &fops_spectral_fft_period);
1118}
1119EXPORT_SYMBOL(ath9k_cmn_spectral_init_debug);
1120