1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/relay.h>
18#include "core.h"
19#include "debug.h"
20#include "wmi-ops.h"
21
22static void send_fft_sample(struct ath10k *ar,
23 const struct fft_sample_tlv *fft_sample_tlv)
24{
25 int length;
26
27 if (!ar->spectral.rfs_chan_spec_scan)
28 return;
29
30 length = __be16_to_cpu(fft_sample_tlv->length) +
31 sizeof(*fft_sample_tlv);
32 relay_write(ar->spectral.rfs_chan_spec_scan, fft_sample_tlv, length);
33}
34
35static uint8_t get_max_exp(s8 max_index, u16 max_magnitude, size_t bin_len,
36 u8 *data)
37{
38 int dc_pos;
39 u8 max_exp;
40
41 dc_pos = bin_len / 2;
42
43
44 if (dc_pos < max_index || -dc_pos >= max_index)
45 return 0;
46
47 for (max_exp = 0; max_exp < 8; max_exp++) {
48 if (data[dc_pos + max_index] == (max_magnitude >> max_exp))
49 break;
50 }
51
52
53 if (data[dc_pos + max_index] != (max_magnitude >> max_exp))
54 return 0;
55
56 return max_exp;
57}
58
59static inline size_t ath10k_spectral_fix_bin_size(struct ath10k *ar,
60 size_t bin_len)
61{
62
63
64
65
66
67
68 if (!is_power_of_2(bin_len))
69 bin_len -= ar->hw_params.spectral_bin_discard;
70
71 return bin_len;
72}
73
74int ath10k_spectral_process_fft(struct ath10k *ar,
75 struct wmi_phyerr_ev_arg *phyerr,
76 const struct phyerr_fft_report *fftr,
77 size_t bin_len, u64 tsf)
78{
79 struct fft_sample_ath10k *fft_sample;
80 u8 buf[sizeof(*fft_sample) + SPECTRAL_ATH10K_MAX_NUM_BINS];
81 u16 freq1, freq2, total_gain_db, base_pwr_db, length, peak_mag;
82 u32 reg0, reg1;
83 u8 chain_idx, *bins;
84 int dc_pos;
85
86 fft_sample = (struct fft_sample_ath10k *)&buf;
87
88 bin_len = ath10k_spectral_fix_bin_size(ar, bin_len);
89
90 if (bin_len < 64 || bin_len > SPECTRAL_ATH10K_MAX_NUM_BINS)
91 return -EINVAL;
92
93 reg0 = __le32_to_cpu(fftr->reg0);
94 reg1 = __le32_to_cpu(fftr->reg1);
95
96 length = sizeof(*fft_sample) - sizeof(struct fft_sample_tlv) + bin_len;
97 fft_sample->tlv.type = ATH_FFT_SAMPLE_ATH10K;
98 fft_sample->tlv.length = __cpu_to_be16(length);
99
100
101
102
103 switch (phyerr->chan_width_mhz) {
104 case 20:
105 fft_sample->chan_width_mhz = 22;
106 break;
107 case 40:
108 fft_sample->chan_width_mhz = 44;
109 break;
110 case 80:
111
112
113
114
115
116
117 if (bin_len == 64)
118 return -EINVAL;
119 fft_sample->chan_width_mhz = 88;
120 break;
121 default:
122 fft_sample->chan_width_mhz = phyerr->chan_width_mhz;
123 }
124
125 fft_sample->relpwr_db = MS(reg1, SEARCH_FFT_REPORT_REG1_RELPWR_DB);
126 fft_sample->avgpwr_db = MS(reg1, SEARCH_FFT_REPORT_REG1_AVGPWR_DB);
127
128 peak_mag = MS(reg1, SEARCH_FFT_REPORT_REG1_PEAK_MAG);
129 fft_sample->max_magnitude = __cpu_to_be16(peak_mag);
130 fft_sample->max_index = MS(reg0, SEARCH_FFT_REPORT_REG0_PEAK_SIDX);
131 fft_sample->rssi = phyerr->rssi_combined;
132
133 total_gain_db = MS(reg0, SEARCH_FFT_REPORT_REG0_TOTAL_GAIN_DB);
134 base_pwr_db = MS(reg0, SEARCH_FFT_REPORT_REG0_BASE_PWR_DB);
135 fft_sample->total_gain_db = __cpu_to_be16(total_gain_db);
136 fft_sample->base_pwr_db = __cpu_to_be16(base_pwr_db);
137
138 freq1 = phyerr->freq1;
139 freq2 = phyerr->freq2;
140 fft_sample->freq1 = __cpu_to_be16(freq1);
141 fft_sample->freq2 = __cpu_to_be16(freq2);
142
143 chain_idx = MS(reg0, SEARCH_FFT_REPORT_REG0_FFT_CHN_IDX);
144
145 fft_sample->noise = __cpu_to_be16(phyerr->nf_chains[chain_idx]);
146
147 bins = (u8 *)fftr;
148 bins += sizeof(*fftr);
149
150 fft_sample->tsf = __cpu_to_be64(tsf);
151
152
153
154
155 fft_sample->max_exp = get_max_exp(fft_sample->max_index, peak_mag,
156 bin_len, bins);
157
158 memcpy(fft_sample->data, bins, bin_len);
159
160
161
162
163 dc_pos = bin_len / 2;
164 fft_sample->data[dc_pos] = (fft_sample->data[dc_pos + 1] +
165 fft_sample->data[dc_pos - 1]) / 2;
166
167 send_fft_sample(ar, &fft_sample->tlv);
168
169 return 0;
170}
171
172static struct ath10k_vif *ath10k_get_spectral_vdev(struct ath10k *ar)
173{
174 struct ath10k_vif *arvif;
175
176 lockdep_assert_held(&ar->conf_mutex);
177
178 if (list_empty(&ar->arvifs))
179 return NULL;
180
181
182 list_for_each_entry(arvif, &ar->arvifs, list)
183 if (arvif->spectral_enabled)
184 return arvif;
185
186
187 return list_first_entry(&ar->arvifs, typeof(*arvif), list);
188}
189
190static int ath10k_spectral_scan_trigger(struct ath10k *ar)
191{
192 struct ath10k_vif *arvif;
193 int res;
194 int vdev_id;
195
196 lockdep_assert_held(&ar->conf_mutex);
197
198 arvif = ath10k_get_spectral_vdev(ar);
199 if (!arvif)
200 return -ENODEV;
201 vdev_id = arvif->vdev_id;
202
203 if (ar->spectral.mode == SPECTRAL_DISABLED)
204 return 0;
205
206 res = ath10k_wmi_vdev_spectral_enable(ar, vdev_id,
207 WMI_SPECTRAL_TRIGGER_CMD_CLEAR,
208 WMI_SPECTRAL_ENABLE_CMD_ENABLE);
209 if (res < 0)
210 return res;
211
212 res = ath10k_wmi_vdev_spectral_enable(ar, vdev_id,
213 WMI_SPECTRAL_TRIGGER_CMD_TRIGGER,
214 WMI_SPECTRAL_ENABLE_CMD_ENABLE);
215 if (res < 0)
216 return res;
217
218 return 0;
219}
220
221static int ath10k_spectral_scan_config(struct ath10k *ar,
222 enum ath10k_spectral_mode mode)
223{
224 struct wmi_vdev_spectral_conf_arg arg;
225 struct ath10k_vif *arvif;
226 int vdev_id, count, res = 0;
227
228 lockdep_assert_held(&ar->conf_mutex);
229
230 arvif = ath10k_get_spectral_vdev(ar);
231 if (!arvif)
232 return -ENODEV;
233
234 vdev_id = arvif->vdev_id;
235
236 arvif->spectral_enabled = (mode != SPECTRAL_DISABLED);
237 ar->spectral.mode = mode;
238
239 res = ath10k_wmi_vdev_spectral_enable(ar, vdev_id,
240 WMI_SPECTRAL_TRIGGER_CMD_CLEAR,
241 WMI_SPECTRAL_ENABLE_CMD_DISABLE);
242 if (res < 0) {
243 ath10k_warn(ar, "failed to enable spectral scan: %d\n", res);
244 return res;
245 }
246
247 if (mode == SPECTRAL_DISABLED)
248 return 0;
249
250 if (mode == SPECTRAL_BACKGROUND)
251 count = WMI_SPECTRAL_COUNT_DEFAULT;
252 else
253 count = max_t(u8, 1, ar->spectral.config.count);
254
255 arg.vdev_id = vdev_id;
256 arg.scan_count = count;
257 arg.scan_period = WMI_SPECTRAL_PERIOD_DEFAULT;
258 arg.scan_priority = WMI_SPECTRAL_PRIORITY_DEFAULT;
259 arg.scan_fft_size = ar->spectral.config.fft_size;
260 arg.scan_gc_ena = WMI_SPECTRAL_GC_ENA_DEFAULT;
261 arg.scan_restart_ena = WMI_SPECTRAL_RESTART_ENA_DEFAULT;
262 arg.scan_noise_floor_ref = WMI_SPECTRAL_NOISE_FLOOR_REF_DEFAULT;
263 arg.scan_init_delay = WMI_SPECTRAL_INIT_DELAY_DEFAULT;
264 arg.scan_nb_tone_thr = WMI_SPECTRAL_NB_TONE_THR_DEFAULT;
265 arg.scan_str_bin_thr = WMI_SPECTRAL_STR_BIN_THR_DEFAULT;
266 arg.scan_wb_rpt_mode = WMI_SPECTRAL_WB_RPT_MODE_DEFAULT;
267 arg.scan_rssi_rpt_mode = WMI_SPECTRAL_RSSI_RPT_MODE_DEFAULT;
268 arg.scan_rssi_thr = WMI_SPECTRAL_RSSI_THR_DEFAULT;
269 arg.scan_pwr_format = WMI_SPECTRAL_PWR_FORMAT_DEFAULT;
270 arg.scan_rpt_mode = WMI_SPECTRAL_RPT_MODE_DEFAULT;
271 arg.scan_bin_scale = WMI_SPECTRAL_BIN_SCALE_DEFAULT;
272 arg.scan_dbm_adj = WMI_SPECTRAL_DBM_ADJ_DEFAULT;
273 arg.scan_chn_mask = WMI_SPECTRAL_CHN_MASK_DEFAULT;
274
275 res = ath10k_wmi_vdev_spectral_conf(ar, &arg);
276 if (res < 0) {
277 ath10k_warn(ar, "failed to configure spectral scan: %d\n", res);
278 return res;
279 }
280
281 return 0;
282}
283
284static ssize_t read_file_spec_scan_ctl(struct file *file, char __user *user_buf,
285 size_t count, loff_t *ppos)
286{
287 struct ath10k *ar = file->private_data;
288 char *mode = "";
289 size_t len;
290 enum ath10k_spectral_mode spectral_mode;
291
292 mutex_lock(&ar->conf_mutex);
293 spectral_mode = ar->spectral.mode;
294 mutex_unlock(&ar->conf_mutex);
295
296 switch (spectral_mode) {
297 case SPECTRAL_DISABLED:
298 mode = "disable";
299 break;
300 case SPECTRAL_BACKGROUND:
301 mode = "background";
302 break;
303 case SPECTRAL_MANUAL:
304 mode = "manual";
305 break;
306 }
307
308 len = strlen(mode);
309 return simple_read_from_buffer(user_buf, count, ppos, mode, len);
310}
311
312static ssize_t write_file_spec_scan_ctl(struct file *file,
313 const char __user *user_buf,
314 size_t count, loff_t *ppos)
315{
316 struct ath10k *ar = file->private_data;
317 char buf[32];
318 ssize_t len;
319 int res;
320
321 len = min(count, sizeof(buf) - 1);
322 if (copy_from_user(buf, user_buf, len))
323 return -EFAULT;
324
325 buf[len] = '\0';
326
327 mutex_lock(&ar->conf_mutex);
328
329 if (strncmp("trigger", buf, 7) == 0) {
330 if (ar->spectral.mode == SPECTRAL_MANUAL ||
331 ar->spectral.mode == SPECTRAL_BACKGROUND) {
332
333
334
335 res = ath10k_spectral_scan_config(ar,
336 ar->spectral.mode);
337 if (res < 0) {
338 ath10k_warn(ar, "failed to reconfigure spectral scan: %d\n",
339 res);
340 }
341 res = ath10k_spectral_scan_trigger(ar);
342 if (res < 0) {
343 ath10k_warn(ar, "failed to trigger spectral scan: %d\n",
344 res);
345 }
346 } else {
347 res = -EINVAL;
348 }
349 } else if (strncmp("background", buf, 10) == 0) {
350 res = ath10k_spectral_scan_config(ar, SPECTRAL_BACKGROUND);
351 } else if (strncmp("manual", buf, 6) == 0) {
352 res = ath10k_spectral_scan_config(ar, SPECTRAL_MANUAL);
353 } else if (strncmp("disable", buf, 7) == 0) {
354 res = ath10k_spectral_scan_config(ar, SPECTRAL_DISABLED);
355 } else {
356 res = -EINVAL;
357 }
358
359 mutex_unlock(&ar->conf_mutex);
360
361 if (res < 0)
362 return res;
363
364 return count;
365}
366
367static const struct file_operations fops_spec_scan_ctl = {
368 .read = read_file_spec_scan_ctl,
369 .write = write_file_spec_scan_ctl,
370 .open = simple_open,
371 .owner = THIS_MODULE,
372 .llseek = default_llseek,
373};
374
375static ssize_t read_file_spectral_count(struct file *file,
376 char __user *user_buf,
377 size_t count, loff_t *ppos)
378{
379 struct ath10k *ar = file->private_data;
380 char buf[32];
381 size_t len;
382 u8 spectral_count;
383
384 mutex_lock(&ar->conf_mutex);
385 spectral_count = ar->spectral.config.count;
386 mutex_unlock(&ar->conf_mutex);
387
388 len = sprintf(buf, "%d\n", spectral_count);
389 return simple_read_from_buffer(user_buf, count, ppos, buf, len);
390}
391
392static ssize_t write_file_spectral_count(struct file *file,
393 const char __user *user_buf,
394 size_t count, loff_t *ppos)
395{
396 struct ath10k *ar = file->private_data;
397 unsigned long val;
398 char buf[32];
399 ssize_t len;
400
401 len = min(count, sizeof(buf) - 1);
402 if (copy_from_user(buf, user_buf, len))
403 return -EFAULT;
404
405 buf[len] = '\0';
406 if (kstrtoul(buf, 0, &val))
407 return -EINVAL;
408
409 if (val < 0 || val > 255)
410 return -EINVAL;
411
412 mutex_lock(&ar->conf_mutex);
413 ar->spectral.config.count = val;
414 mutex_unlock(&ar->conf_mutex);
415
416 return count;
417}
418
419static const struct file_operations fops_spectral_count = {
420 .read = read_file_spectral_count,
421 .write = write_file_spectral_count,
422 .open = simple_open,
423 .owner = THIS_MODULE,
424 .llseek = default_llseek,
425};
426
427static ssize_t read_file_spectral_bins(struct file *file,
428 char __user *user_buf,
429 size_t count, loff_t *ppos)
430{
431 struct ath10k *ar = file->private_data;
432 char buf[32];
433 unsigned int bins, fft_size, bin_scale;
434 size_t len;
435
436 mutex_lock(&ar->conf_mutex);
437
438 fft_size = ar->spectral.config.fft_size;
439 bin_scale = WMI_SPECTRAL_BIN_SCALE_DEFAULT;
440 bins = 1 << (fft_size - bin_scale);
441
442 mutex_unlock(&ar->conf_mutex);
443
444 len = sprintf(buf, "%d\n", bins);
445 return simple_read_from_buffer(user_buf, count, ppos, buf, len);
446}
447
448static ssize_t write_file_spectral_bins(struct file *file,
449 const char __user *user_buf,
450 size_t count, loff_t *ppos)
451{
452 struct ath10k *ar = file->private_data;
453 unsigned long val;
454 char buf[32];
455 ssize_t len;
456
457 len = min(count, sizeof(buf) - 1);
458 if (copy_from_user(buf, user_buf, len))
459 return -EFAULT;
460
461 buf[len] = '\0';
462 if (kstrtoul(buf, 0, &val))
463 return -EINVAL;
464
465 if (val < 64 || val > SPECTRAL_ATH10K_MAX_NUM_BINS)
466 return -EINVAL;
467
468 if (!is_power_of_2(val))
469 return -EINVAL;
470
471 mutex_lock(&ar->conf_mutex);
472 ar->spectral.config.fft_size = ilog2(val);
473 ar->spectral.config.fft_size += WMI_SPECTRAL_BIN_SCALE_DEFAULT;
474 mutex_unlock(&ar->conf_mutex);
475
476 return count;
477}
478
479static const struct file_operations fops_spectral_bins = {
480 .read = read_file_spectral_bins,
481 .write = write_file_spectral_bins,
482 .open = simple_open,
483 .owner = THIS_MODULE,
484 .llseek = default_llseek,
485};
486
487static struct dentry *create_buf_file_handler(const char *filename,
488 struct dentry *parent,
489 umode_t mode,
490 struct rchan_buf *buf,
491 int *is_global)
492{
493 struct dentry *buf_file;
494
495 buf_file = debugfs_create_file(filename, mode, parent, buf,
496 &relay_file_operations);
497 *is_global = 1;
498 return buf_file;
499}
500
501static int remove_buf_file_handler(struct dentry *dentry)
502{
503 debugfs_remove(dentry);
504
505 return 0;
506}
507
508static struct rchan_callbacks rfs_spec_scan_cb = {
509 .create_buf_file = create_buf_file_handler,
510 .remove_buf_file = remove_buf_file_handler,
511};
512
513int ath10k_spectral_start(struct ath10k *ar)
514{
515 struct ath10k_vif *arvif;
516
517 lockdep_assert_held(&ar->conf_mutex);
518
519 list_for_each_entry(arvif, &ar->arvifs, list)
520 arvif->spectral_enabled = 0;
521
522 ar->spectral.mode = SPECTRAL_DISABLED;
523 ar->spectral.config.count = WMI_SPECTRAL_COUNT_DEFAULT;
524 ar->spectral.config.fft_size = WMI_SPECTRAL_FFT_SIZE_DEFAULT;
525
526 return 0;
527}
528
529int ath10k_spectral_vif_stop(struct ath10k_vif *arvif)
530{
531 if (!arvif->spectral_enabled)
532 return 0;
533
534 return ath10k_spectral_scan_config(arvif->ar, SPECTRAL_DISABLED);
535}
536
537int ath10k_spectral_create(struct ath10k *ar)
538{
539
540
541
542 ar->spectral.rfs_chan_spec_scan = relay_open("spectral_scan",
543 ar->debug.debugfs_phy,
544 1140, 2500,
545 &rfs_spec_scan_cb, NULL);
546 debugfs_create_file("spectral_scan_ctl",
547 0600,
548 ar->debug.debugfs_phy, ar,
549 &fops_spec_scan_ctl);
550 debugfs_create_file("spectral_count",
551 0600,
552 ar->debug.debugfs_phy, ar,
553 &fops_spectral_count);
554 debugfs_create_file("spectral_bins",
555 0600,
556 ar->debug.debugfs_phy, ar,
557 &fops_spectral_bins);
558
559 return 0;
560}
561
562void ath10k_spectral_destroy(struct ath10k *ar)
563{
564 if (ar->spectral.rfs_chan_spec_scan) {
565 relay_close(ar->spectral.rfs_chan_spec_scan);
566 ar->spectral.rfs_chan_spec_scan = NULL;
567 }
568}
569