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