1 /****************************************************************************** 2 * 3 * This file is provided under a dual BSD/GPLv2 license. When using or 4 * redistributing this file, you may do so under either license. 5 * 6 * GPL LICENSE SUMMARY 7 * 8 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. 9 * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH 10 * Copyright(c) 2016 - 2017 Intel Deutschland GmbH 11 * Copyright(c) 2018 Intel Corporation 12 * 13 * This program is free software; you can redistribute it and/or modify 14 * it under the terms of version 2 of the GNU General Public License as 15 * published by the Free Software Foundation. 16 * 17 * This program is distributed in the hope that it will be useful, but 18 * WITHOUT ANY WARRANTY; without even the implied warranty of 19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 20 * General Public License for more details. 21 * 22 * The full GNU General Public License is included in this distribution 23 * in the file called COPYING. 24 * 25 * Contact Information: 26 * Intel Linux Wireless <linuxwifi@intel.com> 27 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 28 * 29 * BSD LICENSE 30 * 31 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. 32 * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH 33 * Copyright(c) 2016 - 2017 Intel Deutschland GmbH 34 * Copyright(c) 2018 Intel Corporation 35 * All rights reserved. 36 * 37 * Redistribution and use in source and binary forms, with or without 38 * modification, are permitted provided that the following conditions 39 * are met: 40 * 41 * * Redistributions of source code must retain the above copyright 42 * notice, this list of conditions and the following disclaimer. 43 * * Redistributions in binary form must reproduce the above copyright 44 * notice, this list of conditions and the following disclaimer in 45 * the documentation and/or other materials provided with the 46 * distribution. 47 * * Neither the name Intel Corporation nor the names of its 48 * contributors may be used to endorse or promote products derived 49 * from this software without specific prior written permission. 50 * 51 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 52 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 53 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 54 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 55 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 56 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 57 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 58 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 59 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 60 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 61 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 62 * 63 *****************************************************************************/ 64 #include <linux/vmalloc.h> 65 #include <linux/ieee80211.h> 66 #include <linux/netdevice.h> 67 68 #include "mvm.h" 69 #include "sta.h" 70 #include "iwl-io.h" 71 #include "debugfs.h" 72 #include "iwl-modparams.h" 73 #include "fw/error-dump.h" 74 75 static ssize_t iwl_dbgfs_ctdp_budget_read(struct file *file, 76 char __user *user_buf, 77 size_t count, loff_t *ppos) 78 { 79 struct iwl_mvm *mvm = file->private_data; 80 char buf[16]; 81 int pos, budget; 82 83 if (!iwl_mvm_is_ctdp_supported(mvm)) 84 return -EOPNOTSUPP; 85 86 if (!iwl_mvm_firmware_running(mvm) || 87 mvm->fwrt.cur_fw_img != IWL_UCODE_REGULAR) 88 return -EIO; 89 90 mutex_lock(&mvm->mutex); 91 budget = iwl_mvm_ctdp_command(mvm, CTDP_CMD_OPERATION_REPORT, 0); 92 mutex_unlock(&mvm->mutex); 93 94 if (budget < 0) 95 return budget; 96 97 pos = scnprintf(buf, sizeof(buf), "%d\n", budget); 98 99 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 100 } 101 102 static ssize_t iwl_dbgfs_stop_ctdp_write(struct iwl_mvm *mvm, char *buf, 103 size_t count, loff_t *ppos) 104 { 105 int ret; 106 107 if (!iwl_mvm_is_ctdp_supported(mvm)) 108 return -EOPNOTSUPP; 109 110 if (!iwl_mvm_firmware_running(mvm) || 111 mvm->fwrt.cur_fw_img != IWL_UCODE_REGULAR) 112 return -EIO; 113 114 mutex_lock(&mvm->mutex); 115 ret = iwl_mvm_ctdp_command(mvm, CTDP_CMD_OPERATION_STOP, 0); 116 mutex_unlock(&mvm->mutex); 117 118 return ret ?: count; 119 } 120 121 static ssize_t iwl_dbgfs_force_ctkill_write(struct iwl_mvm *mvm, char *buf, 122 size_t count, loff_t *ppos) 123 { 124 if (!iwl_mvm_firmware_running(mvm) || 125 mvm->fwrt.cur_fw_img != IWL_UCODE_REGULAR) 126 return -EIO; 127 128 iwl_mvm_enter_ctkill(mvm); 129 130 return count; 131 } 132 133 static ssize_t iwl_dbgfs_tx_flush_write(struct iwl_mvm *mvm, char *buf, 134 size_t count, loff_t *ppos) 135 { 136 int ret; 137 u32 flush_arg; 138 139 if (!iwl_mvm_firmware_running(mvm) || 140 mvm->fwrt.cur_fw_img != IWL_UCODE_REGULAR) 141 return -EIO; 142 143 if (kstrtou32(buf, 0, &flush_arg)) 144 return -EINVAL; 145 146 if (iwl_mvm_has_new_tx_api(mvm)) { 147 IWL_DEBUG_TX_QUEUES(mvm, 148 "FLUSHING all tids queues on sta_id = %d\n", 149 flush_arg); 150 mutex_lock(&mvm->mutex); 151 ret = iwl_mvm_flush_sta_tids(mvm, flush_arg, 0xFF, 0) ? : count; 152 mutex_unlock(&mvm->mutex); 153 return ret; 154 } 155 156 IWL_DEBUG_TX_QUEUES(mvm, "FLUSHING queues mask to flush = 0x%x\n", 157 flush_arg); 158 159 mutex_lock(&mvm->mutex); 160 ret = iwl_mvm_flush_tx_path(mvm, flush_arg, 0) ? : count; 161 mutex_unlock(&mvm->mutex); 162 163 return ret; 164 } 165 166 static ssize_t iwl_dbgfs_sta_drain_write(struct iwl_mvm *mvm, char *buf, 167 size_t count, loff_t *ppos) 168 { 169 struct iwl_mvm_sta *mvmsta; 170 int sta_id, drain, ret; 171 172 if (!iwl_mvm_firmware_running(mvm) || 173 mvm->fwrt.cur_fw_img != IWL_UCODE_REGULAR) 174 return -EIO; 175 176 if (sscanf(buf, "%d %d", &sta_id, &drain) != 2) 177 return -EINVAL; 178 if (sta_id < 0 || sta_id >= IWL_MVM_STATION_COUNT) 179 return -EINVAL; 180 if (drain < 0 || drain > 1) 181 return -EINVAL; 182 183 mutex_lock(&mvm->mutex); 184 185 mvmsta = iwl_mvm_sta_from_staid_protected(mvm, sta_id); 186 187 if (!mvmsta) 188 ret = -ENOENT; 189 else 190 ret = iwl_mvm_drain_sta(mvm, mvmsta, drain) ? : count; 191 192 mutex_unlock(&mvm->mutex); 193 194 return ret; 195 } 196 197 static ssize_t iwl_dbgfs_sram_read(struct file *file, char __user *user_buf, 198 size_t count, loff_t *ppos) 199 { 200 struct iwl_mvm *mvm = file->private_data; 201 const struct fw_img *img; 202 unsigned int ofs, len; 203 size_t ret; 204 u8 *ptr; 205 206 if (!iwl_mvm_firmware_running(mvm)) 207 return -EINVAL; 208 209 /* default is to dump the entire data segment */ 210 img = &mvm->fw->img[mvm->fwrt.cur_fw_img]; 211 ofs = img->sec[IWL_UCODE_SECTION_DATA].offset; 212 len = img->sec[IWL_UCODE_SECTION_DATA].len; 213 214 if (mvm->dbgfs_sram_len) { 215 ofs = mvm->dbgfs_sram_offset; 216 len = mvm->dbgfs_sram_len; 217 } 218 219 ptr = kzalloc(len, GFP_KERNEL); 220 if (!ptr) 221 return -ENOMEM; 222 223 iwl_trans_read_mem_bytes(mvm->trans, ofs, ptr, len); 224 225 ret = simple_read_from_buffer(user_buf, count, ppos, ptr, len); 226 227 kfree(ptr); 228 229 return ret; 230 } 231 232 static ssize_t iwl_dbgfs_sram_write(struct iwl_mvm *mvm, char *buf, 233 size_t count, loff_t *ppos) 234 { 235 const struct fw_img *img; 236 u32 offset, len; 237 u32 img_offset, img_len; 238 239 if (!iwl_mvm_firmware_running(mvm)) 240 return -EINVAL; 241 242 img = &mvm->fw->img[mvm->fwrt.cur_fw_img]; 243 img_offset = img->sec[IWL_UCODE_SECTION_DATA].offset; 244 img_len = img->sec[IWL_UCODE_SECTION_DATA].len; 245 246 if (sscanf(buf, "%x,%x", &offset, &len) == 2) { 247 if ((offset & 0x3) || (len & 0x3)) 248 return -EINVAL; 249 250 if (offset + len > img_offset + img_len) 251 return -EINVAL; 252 253 mvm->dbgfs_sram_offset = offset; 254 mvm->dbgfs_sram_len = len; 255 } else { 256 mvm->dbgfs_sram_offset = 0; 257 mvm->dbgfs_sram_len = 0; 258 } 259 260 return count; 261 } 262 263 static ssize_t iwl_dbgfs_set_nic_temperature_read(struct file *file, 264 char __user *user_buf, 265 size_t count, loff_t *ppos) 266 { 267 struct iwl_mvm *mvm = file->private_data; 268 char buf[16]; 269 int pos; 270 271 if (!mvm->temperature_test) 272 pos = scnprintf(buf , sizeof(buf), "disabled\n"); 273 else 274 pos = scnprintf(buf , sizeof(buf), "%d\n", mvm->temperature); 275 276 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 277 } 278 279 /* 280 * Set NIC Temperature 281 * Cause the driver to ignore the actual NIC temperature reported by the FW 282 * Enable: any value between IWL_MVM_DEBUG_SET_TEMPERATURE_MIN - 283 * IWL_MVM_DEBUG_SET_TEMPERATURE_MAX 284 * Disable: IWL_MVM_DEBUG_SET_TEMPERATURE_DISABLE 285 */ 286 static ssize_t iwl_dbgfs_set_nic_temperature_write(struct iwl_mvm *mvm, 287 char *buf, size_t count, 288 loff_t *ppos) 289 { 290 int temperature; 291 292 if (!iwl_mvm_firmware_running(mvm) && !mvm->temperature_test) 293 return -EIO; 294 295 if (kstrtoint(buf, 10, &temperature)) 296 return -EINVAL; 297 /* not a legal temperature */ 298 if ((temperature > IWL_MVM_DEBUG_SET_TEMPERATURE_MAX && 299 temperature != IWL_MVM_DEBUG_SET_TEMPERATURE_DISABLE) || 300 temperature < IWL_MVM_DEBUG_SET_TEMPERATURE_MIN) 301 return -EINVAL; 302 303 mutex_lock(&mvm->mutex); 304 if (temperature == IWL_MVM_DEBUG_SET_TEMPERATURE_DISABLE) { 305 if (!mvm->temperature_test) 306 goto out; 307 308 mvm->temperature_test = false; 309 /* Since we can't read the temp while awake, just set 310 * it to zero until we get the next RX stats from the 311 * firmware. 312 */ 313 mvm->temperature = 0; 314 } else { 315 mvm->temperature_test = true; 316 mvm->temperature = temperature; 317 } 318 IWL_DEBUG_TEMP(mvm, "%sabling debug set temperature (temp = %d)\n", 319 mvm->temperature_test ? "En" : "Dis" , 320 mvm->temperature); 321 /* handle the temperature change */ 322 iwl_mvm_tt_handler(mvm); 323 324 out: 325 mutex_unlock(&mvm->mutex); 326 327 return count; 328 } 329 330 static ssize_t iwl_dbgfs_nic_temp_read(struct file *file, 331 char __user *user_buf, 332 size_t count, loff_t *ppos) 333 { 334 struct iwl_mvm *mvm = file->private_data; 335 char buf[16]; 336 int pos, ret; 337 s32 temp; 338 339 if (!iwl_mvm_firmware_running(mvm)) 340 return -EIO; 341 342 mutex_lock(&mvm->mutex); 343 ret = iwl_mvm_get_temp(mvm, &temp); 344 mutex_unlock(&mvm->mutex); 345 346 if (ret) 347 return -EIO; 348 349 pos = scnprintf(buf , sizeof(buf), "%d\n", temp); 350 351 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 352 } 353 354 #ifdef CONFIG_ACPI 355 static ssize_t iwl_dbgfs_sar_geo_profile_read(struct file *file, 356 char __user *user_buf, 357 size_t count, loff_t *ppos) 358 { 359 struct iwl_mvm *mvm = file->private_data; 360 char buf[256]; 361 int pos = 0; 362 int bufsz = sizeof(buf); 363 int tbl_idx; 364 u8 *value; 365 366 if (!iwl_mvm_firmware_running(mvm)) 367 return -EIO; 368 369 mutex_lock(&mvm->mutex); 370 tbl_idx = iwl_mvm_get_sar_geo_profile(mvm); 371 if (tbl_idx < 0) { 372 mutex_unlock(&mvm->mutex); 373 return tbl_idx; 374 } 375 376 if (!tbl_idx) { 377 pos = scnprintf(buf, bufsz, 378 "SAR geographic profile disabled\n"); 379 } else { 380 value = &mvm->geo_profiles[tbl_idx - 1].values[0]; 381 382 pos += scnprintf(buf + pos, bufsz - pos, 383 "Use geographic profile %d\n", tbl_idx); 384 pos += scnprintf(buf + pos, bufsz - pos, 385 "2.4GHz:\n\tChain A offset: %hhd dBm\n\tChain B offset: %hhd dBm\n\tmax tx power: %hhd dBm\n", 386 value[1], value[2], value[0]); 387 pos += scnprintf(buf + pos, bufsz - pos, 388 "5.2GHz:\n\tChain A offset: %hhd dBm\n\tChain B offset: %hhd dBm\n\tmax tx power: %hhd dBm\n", 389 value[4], value[5], value[3]); 390 } 391 mutex_unlock(&mvm->mutex); 392 393 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 394 } 395 #endif 396 397 static ssize_t iwl_dbgfs_stations_read(struct file *file, char __user *user_buf, 398 size_t count, loff_t *ppos) 399 { 400 struct iwl_mvm *mvm = file->private_data; 401 struct ieee80211_sta *sta; 402 char buf[400]; 403 int i, pos = 0, bufsz = sizeof(buf); 404 405 mutex_lock(&mvm->mutex); 406 407 for (i = 0; i < ARRAY_SIZE(mvm->fw_id_to_mac_id); i++) { 408 pos += scnprintf(buf + pos, bufsz - pos, "%.2d: ", i); 409 sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[i], 410 lockdep_is_held(&mvm->mutex)); 411 if (!sta) 412 pos += scnprintf(buf + pos, bufsz - pos, "N/A\n"); 413 else if (IS_ERR(sta)) 414 pos += scnprintf(buf + pos, bufsz - pos, "%ld\n", 415 PTR_ERR(sta)); 416 else 417 pos += scnprintf(buf + pos, bufsz - pos, "%pM\n", 418 sta->addr); 419 } 420 421 mutex_unlock(&mvm->mutex); 422 423 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 424 } 425 426 static ssize_t iwl_dbgfs_rs_data_read(struct file *file, char __user *user_buf, 427 size_t count, loff_t *ppos) 428 { 429 struct ieee80211_sta *sta = file->private_data; 430 struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta); 431 struct iwl_lq_sta_rs_fw *lq_sta = &mvmsta->lq_sta.rs_fw; 432 struct iwl_mvm *mvm = lq_sta->pers.drv; 433 static const size_t bufsz = 2048; 434 char *buff; 435 int desc = 0; 436 ssize_t ret; 437 438 buff = kmalloc(bufsz, GFP_KERNEL); 439 if (!buff) 440 return -ENOMEM; 441 442 mutex_lock(&mvm->mutex); 443 444 desc += scnprintf(buff + desc, bufsz - desc, "sta_id %d\n", 445 lq_sta->pers.sta_id); 446 desc += scnprintf(buff + desc, bufsz - desc, 447 "fixed rate 0x%X\n", 448 lq_sta->pers.dbg_fixed_rate); 449 desc += scnprintf(buff + desc, bufsz - desc, 450 "A-MPDU size limit %d\n", 451 lq_sta->pers.dbg_agg_frame_count_lim); 452 desc += scnprintf(buff + desc, bufsz - desc, 453 "valid_tx_ant %s%s%s\n", 454 (iwl_mvm_get_valid_tx_ant(mvm) & ANT_A) ? "ANT_A," : "", 455 (iwl_mvm_get_valid_tx_ant(mvm) & ANT_B) ? "ANT_B," : "", 456 (iwl_mvm_get_valid_tx_ant(mvm) & ANT_C) ? "ANT_C" : ""); 457 desc += scnprintf(buff + desc, bufsz - desc, 458 "last tx rate=0x%X ", 459 lq_sta->last_rate_n_flags); 460 461 desc += rs_pretty_print_rate(buff + desc, bufsz - desc, 462 lq_sta->last_rate_n_flags); 463 mutex_unlock(&mvm->mutex); 464 465 ret = simple_read_from_buffer(user_buf, count, ppos, buff, desc); 466 kfree(buff); 467 return ret; 468 } 469 470 static ssize_t iwl_dbgfs_disable_power_off_read(struct file *file, 471 char __user *user_buf, 472 size_t count, loff_t *ppos) 473 { 474 struct iwl_mvm *mvm = file->private_data; 475 char buf[64]; 476 int bufsz = sizeof(buf); 477 int pos = 0; 478 479 pos += scnprintf(buf+pos, bufsz-pos, "disable_power_off_d0=%d\n", 480 mvm->disable_power_off); 481 pos += scnprintf(buf+pos, bufsz-pos, "disable_power_off_d3=%d\n", 482 mvm->disable_power_off_d3); 483 484 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 485 } 486 487 static ssize_t iwl_dbgfs_disable_power_off_write(struct iwl_mvm *mvm, char *buf, 488 size_t count, loff_t *ppos) 489 { 490 int ret, val; 491 492 if (!iwl_mvm_firmware_running(mvm)) 493 return -EIO; 494 495 if (!strncmp("disable_power_off_d0=", buf, 21)) { 496 if (sscanf(buf + 21, "%d", &val) != 1) 497 return -EINVAL; 498 mvm->disable_power_off = val; 499 } else if (!strncmp("disable_power_off_d3=", buf, 21)) { 500 if (sscanf(buf + 21, "%d", &val) != 1) 501 return -EINVAL; 502 mvm->disable_power_off_d3 = val; 503 } else { 504 return -EINVAL; 505 } 506 507 mutex_lock(&mvm->mutex); 508 ret = iwl_mvm_power_update_device(mvm); 509 mutex_unlock(&mvm->mutex); 510 511 return ret ?: count; 512 } 513 514 static 515 int iwl_mvm_coex_dump_mbox(struct iwl_bt_coex_profile_notif *notif, char *buf, 516 int pos, int bufsz) 517 { 518 pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw0:\n"); 519 520 BT_MBOX_PRINT(0, LE_SLAVE_LAT, false); 521 BT_MBOX_PRINT(0, LE_PROF1, false); 522 BT_MBOX_PRINT(0, LE_PROF2, false); 523 BT_MBOX_PRINT(0, LE_PROF_OTHER, false); 524 BT_MBOX_PRINT(0, CHL_SEQ_N, false); 525 BT_MBOX_PRINT(0, INBAND_S, false); 526 BT_MBOX_PRINT(0, LE_MIN_RSSI, false); 527 BT_MBOX_PRINT(0, LE_SCAN, false); 528 BT_MBOX_PRINT(0, LE_ADV, false); 529 BT_MBOX_PRINT(0, LE_MAX_TX_POWER, false); 530 BT_MBOX_PRINT(0, OPEN_CON_1, true); 531 532 pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw1:\n"); 533 534 BT_MBOX_PRINT(1, BR_MAX_TX_POWER, false); 535 BT_MBOX_PRINT(1, IP_SR, false); 536 BT_MBOX_PRINT(1, LE_MSTR, false); 537 BT_MBOX_PRINT(1, AGGR_TRFC_LD, false); 538 BT_MBOX_PRINT(1, MSG_TYPE, false); 539 BT_MBOX_PRINT(1, SSN, true); 540 541 pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw2:\n"); 542 543 BT_MBOX_PRINT(2, SNIFF_ACT, false); 544 BT_MBOX_PRINT(2, PAG, false); 545 BT_MBOX_PRINT(2, INQUIRY, false); 546 BT_MBOX_PRINT(2, CONN, false); 547 BT_MBOX_PRINT(2, SNIFF_INTERVAL, false); 548 BT_MBOX_PRINT(2, DISC, false); 549 BT_MBOX_PRINT(2, SCO_TX_ACT, false); 550 BT_MBOX_PRINT(2, SCO_RX_ACT, false); 551 BT_MBOX_PRINT(2, ESCO_RE_TX, false); 552 BT_MBOX_PRINT(2, SCO_DURATION, true); 553 554 pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw3:\n"); 555 556 BT_MBOX_PRINT(3, SCO_STATE, false); 557 BT_MBOX_PRINT(3, SNIFF_STATE, false); 558 BT_MBOX_PRINT(3, A2DP_STATE, false); 559 BT_MBOX_PRINT(3, A2DP_SRC, false); 560 BT_MBOX_PRINT(3, ACL_STATE, false); 561 BT_MBOX_PRINT(3, MSTR_STATE, false); 562 BT_MBOX_PRINT(3, OBX_STATE, false); 563 BT_MBOX_PRINT(3, OPEN_CON_2, false); 564 BT_MBOX_PRINT(3, TRAFFIC_LOAD, false); 565 BT_MBOX_PRINT(3, CHL_SEQN_LSB, false); 566 BT_MBOX_PRINT(3, INBAND_P, false); 567 BT_MBOX_PRINT(3, MSG_TYPE_2, false); 568 BT_MBOX_PRINT(3, SSN_2, false); 569 BT_MBOX_PRINT(3, UPDATE_REQUEST, true); 570 571 return pos; 572 } 573 574 static ssize_t iwl_dbgfs_bt_notif_read(struct file *file, char __user *user_buf, 575 size_t count, loff_t *ppos) 576 { 577 struct iwl_mvm *mvm = file->private_data; 578 struct iwl_bt_coex_profile_notif *notif = &mvm->last_bt_notif; 579 char *buf; 580 int ret, pos = 0, bufsz = sizeof(char) * 1024; 581 582 buf = kmalloc(bufsz, GFP_KERNEL); 583 if (!buf) 584 return -ENOMEM; 585 586 mutex_lock(&mvm->mutex); 587 588 pos += iwl_mvm_coex_dump_mbox(notif, buf, pos, bufsz); 589 590 pos += scnprintf(buf + pos, bufsz - pos, "bt_ci_compliance = %d\n", 591 notif->bt_ci_compliance); 592 pos += scnprintf(buf + pos, bufsz - pos, "primary_ch_lut = %d\n", 593 le32_to_cpu(notif->primary_ch_lut)); 594 pos += scnprintf(buf + pos, bufsz - pos, "secondary_ch_lut = %d\n", 595 le32_to_cpu(notif->secondary_ch_lut)); 596 pos += scnprintf(buf + pos, 597 bufsz - pos, "bt_activity_grading = %d\n", 598 le32_to_cpu(notif->bt_activity_grading)); 599 pos += scnprintf(buf + pos, bufsz - pos, "bt_rrc = %d\n", 600 notif->rrc_status & 0xF); 601 pos += scnprintf(buf + pos, bufsz - pos, "bt_ttc = %d\n", 602 notif->ttc_status & 0xF); 603 604 pos += scnprintf(buf + pos, bufsz - pos, "sync_sco = %d\n", 605 IWL_MVM_BT_COEX_SYNC2SCO); 606 pos += scnprintf(buf + pos, bufsz - pos, "mplut = %d\n", 607 IWL_MVM_BT_COEX_MPLUT); 608 609 mutex_unlock(&mvm->mutex); 610 611 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); 612 kfree(buf); 613 614 return ret; 615 } 616 #undef BT_MBOX_PRINT 617 618 static ssize_t iwl_dbgfs_bt_cmd_read(struct file *file, char __user *user_buf, 619 size_t count, loff_t *ppos) 620 { 621 struct iwl_mvm *mvm = file->private_data; 622 struct iwl_bt_coex_ci_cmd *cmd = &mvm->last_bt_ci_cmd; 623 char buf[256]; 624 int bufsz = sizeof(buf); 625 int pos = 0; 626 627 mutex_lock(&mvm->mutex); 628 629 pos += scnprintf(buf + pos, bufsz - pos, "Channel inhibition CMD\n"); 630 pos += scnprintf(buf + pos, bufsz - pos, 631 "\tPrimary Channel Bitmap 0x%016llx\n", 632 le64_to_cpu(cmd->bt_primary_ci)); 633 pos += scnprintf(buf + pos, bufsz - pos, 634 "\tSecondary Channel Bitmap 0x%016llx\n", 635 le64_to_cpu(cmd->bt_secondary_ci)); 636 637 mutex_unlock(&mvm->mutex); 638 639 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 640 } 641 642 static ssize_t 643 iwl_dbgfs_bt_tx_prio_write(struct iwl_mvm *mvm, char *buf, 644 size_t count, loff_t *ppos) 645 { 646 u32 bt_tx_prio; 647 648 if (sscanf(buf, "%u", &bt_tx_prio) != 1) 649 return -EINVAL; 650 if (bt_tx_prio > 4) 651 return -EINVAL; 652 653 mvm->bt_tx_prio = bt_tx_prio; 654 655 return count; 656 } 657 658 static ssize_t 659 iwl_dbgfs_bt_force_ant_write(struct iwl_mvm *mvm, char *buf, 660 size_t count, loff_t *ppos) 661 { 662 static const char * const modes_str[BT_FORCE_ANT_MAX] = { 663 [BT_FORCE_ANT_DIS] = "dis", 664 [BT_FORCE_ANT_AUTO] = "auto", 665 [BT_FORCE_ANT_BT] = "bt", 666 [BT_FORCE_ANT_WIFI] = "wifi", 667 }; 668 int ret, bt_force_ant_mode; 669 670 ret = match_string(modes_str, ARRAY_SIZE(modes_str), buf); 671 if (ret < 0) 672 return ret; 673 674 bt_force_ant_mode = ret; 675 ret = 0; 676 mutex_lock(&mvm->mutex); 677 if (mvm->bt_force_ant_mode == bt_force_ant_mode) 678 goto out; 679 680 mvm->bt_force_ant_mode = bt_force_ant_mode; 681 IWL_DEBUG_COEX(mvm, "Force mode: %s\n", 682 modes_str[mvm->bt_force_ant_mode]); 683 684 if (iwl_mvm_firmware_running(mvm)) 685 ret = iwl_mvm_send_bt_init_conf(mvm); 686 else 687 ret = 0; 688 689 out: 690 mutex_unlock(&mvm->mutex); 691 return ret ?: count; 692 } 693 694 static ssize_t iwl_dbgfs_fw_ver_read(struct file *file, char __user *user_buf, 695 size_t count, loff_t *ppos) 696 { 697 struct iwl_mvm *mvm = file->private_data; 698 char *buff, *pos, *endpos; 699 static const size_t bufsz = 1024; 700 int ret; 701 702 buff = kmalloc(bufsz, GFP_KERNEL); 703 if (!buff) 704 return -ENOMEM; 705 706 pos = buff; 707 endpos = pos + bufsz; 708 709 pos += scnprintf(pos, endpos - pos, "FW prefix: %s\n", 710 mvm->trans->cfg->fw_name_pre); 711 pos += scnprintf(pos, endpos - pos, "FW: %s\n", 712 mvm->fwrt.fw->human_readable); 713 pos += scnprintf(pos, endpos - pos, "Device: %s\n", 714 mvm->fwrt.trans->cfg->name); 715 pos += scnprintf(pos, endpos - pos, "Bus: %s\n", 716 mvm->fwrt.dev->bus->name); 717 718 ret = simple_read_from_buffer(user_buf, count, ppos, buff, pos - buff); 719 kfree(buff); 720 721 return ret; 722 } 723 724 #define PRINT_STATS_LE32(_struct, _memb) \ 725 pos += scnprintf(buf + pos, bufsz - pos, \ 726 fmt_table, #_memb, \ 727 le32_to_cpu(_struct->_memb)) 728 729 static ssize_t iwl_dbgfs_fw_rx_stats_read(struct file *file, 730 char __user *user_buf, size_t count, 731 loff_t *ppos) 732 { 733 struct iwl_mvm *mvm = file->private_data; 734 static const char *fmt_table = "\t%-30s %10u\n"; 735 static const char *fmt_header = "%-32s\n"; 736 int pos = 0; 737 char *buf; 738 int ret; 739 size_t bufsz; 740 741 if (iwl_mvm_has_new_rx_stats_api(mvm)) 742 bufsz = ((sizeof(struct mvm_statistics_rx) / 743 sizeof(__le32)) * 43) + (4 * 33) + 1; 744 else 745 /* 43 = size of each data line; 33 = size of each header */ 746 bufsz = ((sizeof(struct mvm_statistics_rx_v3) / 747 sizeof(__le32)) * 43) + (4 * 33) + 1; 748 749 buf = kzalloc(bufsz, GFP_KERNEL); 750 if (!buf) 751 return -ENOMEM; 752 753 mutex_lock(&mvm->mutex); 754 755 if (iwl_mvm_firmware_running(mvm)) 756 iwl_mvm_request_statistics(mvm, false); 757 758 pos += scnprintf(buf + pos, bufsz - pos, fmt_header, 759 "Statistics_Rx - OFDM"); 760 if (!iwl_mvm_has_new_rx_stats_api(mvm)) { 761 struct mvm_statistics_rx_phy_v2 *ofdm = &mvm->rx_stats_v3.ofdm; 762 763 PRINT_STATS_LE32(ofdm, ina_cnt); 764 PRINT_STATS_LE32(ofdm, fina_cnt); 765 PRINT_STATS_LE32(ofdm, plcp_err); 766 PRINT_STATS_LE32(ofdm, crc32_err); 767 PRINT_STATS_LE32(ofdm, overrun_err); 768 PRINT_STATS_LE32(ofdm, early_overrun_err); 769 PRINT_STATS_LE32(ofdm, crc32_good); 770 PRINT_STATS_LE32(ofdm, false_alarm_cnt); 771 PRINT_STATS_LE32(ofdm, fina_sync_err_cnt); 772 PRINT_STATS_LE32(ofdm, sfd_timeout); 773 PRINT_STATS_LE32(ofdm, fina_timeout); 774 PRINT_STATS_LE32(ofdm, unresponded_rts); 775 PRINT_STATS_LE32(ofdm, rxe_frame_lmt_overrun); 776 PRINT_STATS_LE32(ofdm, sent_ack_cnt); 777 PRINT_STATS_LE32(ofdm, sent_cts_cnt); 778 PRINT_STATS_LE32(ofdm, sent_ba_rsp_cnt); 779 PRINT_STATS_LE32(ofdm, dsp_self_kill); 780 PRINT_STATS_LE32(ofdm, mh_format_err); 781 PRINT_STATS_LE32(ofdm, re_acq_main_rssi_sum); 782 PRINT_STATS_LE32(ofdm, reserved); 783 } else { 784 struct mvm_statistics_rx_phy *ofdm = &mvm->rx_stats.ofdm; 785 786 PRINT_STATS_LE32(ofdm, unresponded_rts); 787 PRINT_STATS_LE32(ofdm, rxe_frame_lmt_overrun); 788 PRINT_STATS_LE32(ofdm, sent_ba_rsp_cnt); 789 PRINT_STATS_LE32(ofdm, dsp_self_kill); 790 PRINT_STATS_LE32(ofdm, reserved); 791 } 792 793 pos += scnprintf(buf + pos, bufsz - pos, fmt_header, 794 "Statistics_Rx - CCK"); 795 if (!iwl_mvm_has_new_rx_stats_api(mvm)) { 796 struct mvm_statistics_rx_phy_v2 *cck = &mvm->rx_stats_v3.cck; 797 798 PRINT_STATS_LE32(cck, ina_cnt); 799 PRINT_STATS_LE32(cck, fina_cnt); 800 PRINT_STATS_LE32(cck, plcp_err); 801 PRINT_STATS_LE32(cck, crc32_err); 802 PRINT_STATS_LE32(cck, overrun_err); 803 PRINT_STATS_LE32(cck, early_overrun_err); 804 PRINT_STATS_LE32(cck, crc32_good); 805 PRINT_STATS_LE32(cck, false_alarm_cnt); 806 PRINT_STATS_LE32(cck, fina_sync_err_cnt); 807 PRINT_STATS_LE32(cck, sfd_timeout); 808 PRINT_STATS_LE32(cck, fina_timeout); 809 PRINT_STATS_LE32(cck, unresponded_rts); 810 PRINT_STATS_LE32(cck, rxe_frame_lmt_overrun); 811 PRINT_STATS_LE32(cck, sent_ack_cnt); 812 PRINT_STATS_LE32(cck, sent_cts_cnt); 813 PRINT_STATS_LE32(cck, sent_ba_rsp_cnt); 814 PRINT_STATS_LE32(cck, dsp_self_kill); 815 PRINT_STATS_LE32(cck, mh_format_err); 816 PRINT_STATS_LE32(cck, re_acq_main_rssi_sum); 817 PRINT_STATS_LE32(cck, reserved); 818 } else { 819 struct mvm_statistics_rx_phy *cck = &mvm->rx_stats.cck; 820 821 PRINT_STATS_LE32(cck, unresponded_rts); 822 PRINT_STATS_LE32(cck, rxe_frame_lmt_overrun); 823 PRINT_STATS_LE32(cck, sent_ba_rsp_cnt); 824 PRINT_STATS_LE32(cck, dsp_self_kill); 825 PRINT_STATS_LE32(cck, reserved); 826 } 827 828 pos += scnprintf(buf + pos, bufsz - pos, fmt_header, 829 "Statistics_Rx - GENERAL"); 830 if (!iwl_mvm_has_new_rx_stats_api(mvm)) { 831 struct mvm_statistics_rx_non_phy_v3 *general = 832 &mvm->rx_stats_v3.general; 833 834 PRINT_STATS_LE32(general, bogus_cts); 835 PRINT_STATS_LE32(general, bogus_ack); 836 PRINT_STATS_LE32(general, non_bssid_frames); 837 PRINT_STATS_LE32(general, filtered_frames); 838 PRINT_STATS_LE32(general, non_channel_beacons); 839 PRINT_STATS_LE32(general, channel_beacons); 840 PRINT_STATS_LE32(general, num_missed_bcon); 841 PRINT_STATS_LE32(general, adc_rx_saturation_time); 842 PRINT_STATS_LE32(general, ina_detection_search_time); 843 PRINT_STATS_LE32(general, beacon_silence_rssi_a); 844 PRINT_STATS_LE32(general, beacon_silence_rssi_b); 845 PRINT_STATS_LE32(general, beacon_silence_rssi_c); 846 PRINT_STATS_LE32(general, interference_data_flag); 847 PRINT_STATS_LE32(general, channel_load); 848 PRINT_STATS_LE32(general, dsp_false_alarms); 849 PRINT_STATS_LE32(general, beacon_rssi_a); 850 PRINT_STATS_LE32(general, beacon_rssi_b); 851 PRINT_STATS_LE32(general, beacon_rssi_c); 852 PRINT_STATS_LE32(general, beacon_energy_a); 853 PRINT_STATS_LE32(general, beacon_energy_b); 854 PRINT_STATS_LE32(general, beacon_energy_c); 855 PRINT_STATS_LE32(general, num_bt_kills); 856 PRINT_STATS_LE32(general, mac_id); 857 PRINT_STATS_LE32(general, directed_data_mpdu); 858 } else { 859 struct mvm_statistics_rx_non_phy *general = 860 &mvm->rx_stats.general; 861 862 PRINT_STATS_LE32(general, bogus_cts); 863 PRINT_STATS_LE32(general, bogus_ack); 864 PRINT_STATS_LE32(general, non_channel_beacons); 865 PRINT_STATS_LE32(general, channel_beacons); 866 PRINT_STATS_LE32(general, num_missed_bcon); 867 PRINT_STATS_LE32(general, adc_rx_saturation_time); 868 PRINT_STATS_LE32(general, ina_detection_search_time); 869 PRINT_STATS_LE32(general, beacon_silence_rssi_a); 870 PRINT_STATS_LE32(general, beacon_silence_rssi_b); 871 PRINT_STATS_LE32(general, beacon_silence_rssi_c); 872 PRINT_STATS_LE32(general, interference_data_flag); 873 PRINT_STATS_LE32(general, channel_load); 874 PRINT_STATS_LE32(general, beacon_rssi_a); 875 PRINT_STATS_LE32(general, beacon_rssi_b); 876 PRINT_STATS_LE32(general, beacon_rssi_c); 877 PRINT_STATS_LE32(general, beacon_energy_a); 878 PRINT_STATS_LE32(general, beacon_energy_b); 879 PRINT_STATS_LE32(general, beacon_energy_c); 880 PRINT_STATS_LE32(general, num_bt_kills); 881 PRINT_STATS_LE32(general, mac_id); 882 } 883 884 pos += scnprintf(buf + pos, bufsz - pos, fmt_header, 885 "Statistics_Rx - HT"); 886 if (!iwl_mvm_has_new_rx_stats_api(mvm)) { 887 struct mvm_statistics_rx_ht_phy_v1 *ht = 888 &mvm->rx_stats_v3.ofdm_ht; 889 890 PRINT_STATS_LE32(ht, plcp_err); 891 PRINT_STATS_LE32(ht, overrun_err); 892 PRINT_STATS_LE32(ht, early_overrun_err); 893 PRINT_STATS_LE32(ht, crc32_good); 894 PRINT_STATS_LE32(ht, crc32_err); 895 PRINT_STATS_LE32(ht, mh_format_err); 896 PRINT_STATS_LE32(ht, agg_crc32_good); 897 PRINT_STATS_LE32(ht, agg_mpdu_cnt); 898 PRINT_STATS_LE32(ht, agg_cnt); 899 PRINT_STATS_LE32(ht, unsupport_mcs); 900 } else { 901 struct mvm_statistics_rx_ht_phy *ht = 902 &mvm->rx_stats.ofdm_ht; 903 904 PRINT_STATS_LE32(ht, mh_format_err); 905 PRINT_STATS_LE32(ht, agg_mpdu_cnt); 906 PRINT_STATS_LE32(ht, agg_cnt); 907 PRINT_STATS_LE32(ht, unsupport_mcs); 908 } 909 910 mutex_unlock(&mvm->mutex); 911 912 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); 913 kfree(buf); 914 915 return ret; 916 } 917 #undef PRINT_STAT_LE32 918 919 static ssize_t iwl_dbgfs_frame_stats_read(struct iwl_mvm *mvm, 920 char __user *user_buf, size_t count, 921 loff_t *ppos, 922 struct iwl_mvm_frame_stats *stats) 923 { 924 char *buff, *pos, *endpos; 925 int idx, i; 926 int ret; 927 static const size_t bufsz = 1024; 928 929 buff = kmalloc(bufsz, GFP_KERNEL); 930 if (!buff) 931 return -ENOMEM; 932 933 spin_lock_bh(&mvm->drv_stats_lock); 934 935 pos = buff; 936 endpos = pos + bufsz; 937 938 pos += scnprintf(pos, endpos - pos, 939 "Legacy/HT/VHT\t:\t%d/%d/%d\n", 940 stats->legacy_frames, 941 stats->ht_frames, 942 stats->vht_frames); 943 pos += scnprintf(pos, endpos - pos, "20/40/80\t:\t%d/%d/%d\n", 944 stats->bw_20_frames, 945 stats->bw_40_frames, 946 stats->bw_80_frames); 947 pos += scnprintf(pos, endpos - pos, "NGI/SGI\t\t:\t%d/%d\n", 948 stats->ngi_frames, 949 stats->sgi_frames); 950 pos += scnprintf(pos, endpos - pos, "SISO/MIMO2\t:\t%d/%d\n", 951 stats->siso_frames, 952 stats->mimo2_frames); 953 pos += scnprintf(pos, endpos - pos, "FAIL/SCSS\t:\t%d/%d\n", 954 stats->fail_frames, 955 stats->success_frames); 956 pos += scnprintf(pos, endpos - pos, "MPDUs agg\t:\t%d\n", 957 stats->agg_frames); 958 pos += scnprintf(pos, endpos - pos, "A-MPDUs\t\t:\t%d\n", 959 stats->ampdu_count); 960 pos += scnprintf(pos, endpos - pos, "Avg MPDUs/A-MPDU:\t%d\n", 961 stats->ampdu_count > 0 ? 962 (stats->agg_frames / stats->ampdu_count) : 0); 963 964 pos += scnprintf(pos, endpos - pos, "Last Rates\n"); 965 966 idx = stats->last_frame_idx - 1; 967 for (i = 0; i < ARRAY_SIZE(stats->last_rates); i++) { 968 idx = (idx + 1) % ARRAY_SIZE(stats->last_rates); 969 if (stats->last_rates[idx] == 0) 970 continue; 971 pos += scnprintf(pos, endpos - pos, "Rate[%d]: ", 972 (int)(ARRAY_SIZE(stats->last_rates) - i)); 973 pos += rs_pretty_print_rate(pos, endpos - pos, 974 stats->last_rates[idx]); 975 } 976 spin_unlock_bh(&mvm->drv_stats_lock); 977 978 ret = simple_read_from_buffer(user_buf, count, ppos, buff, pos - buff); 979 kfree(buff); 980 981 return ret; 982 } 983 984 static ssize_t iwl_dbgfs_drv_rx_stats_read(struct file *file, 985 char __user *user_buf, size_t count, 986 loff_t *ppos) 987 { 988 struct iwl_mvm *mvm = file->private_data; 989 990 return iwl_dbgfs_frame_stats_read(mvm, user_buf, count, ppos, 991 &mvm->drv_rx_stats); 992 } 993 994 static ssize_t iwl_dbgfs_fw_restart_write(struct iwl_mvm *mvm, char *buf, 995 size_t count, loff_t *ppos) 996 { 997 int __maybe_unused ret; 998 999 if (!iwl_mvm_firmware_running(mvm)) 1000 return -EIO; 1001 1002 mutex_lock(&mvm->mutex); 1003 1004 /* allow one more restart that we're provoking here */ 1005 if (mvm->fw_restart >= 0) 1006 mvm->fw_restart++; 1007 1008 /* take the return value to make compiler happy - it will fail anyway */ 1009 ret = iwl_mvm_send_cmd_pdu(mvm, REPLY_ERROR, 0, 0, NULL); 1010 1011 mutex_unlock(&mvm->mutex); 1012 1013 return count; 1014 } 1015 1016 static ssize_t iwl_dbgfs_fw_nmi_write(struct iwl_mvm *mvm, char *buf, 1017 size_t count, loff_t *ppos) 1018 { 1019 int ret; 1020 1021 if (!iwl_mvm_firmware_running(mvm)) 1022 return -EIO; 1023 1024 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_NMI); 1025 if (ret) 1026 return ret; 1027 1028 iwl_force_nmi(mvm->trans); 1029 1030 iwl_mvm_unref(mvm, IWL_MVM_REF_NMI); 1031 1032 return count; 1033 } 1034 1035 static ssize_t 1036 iwl_dbgfs_scan_ant_rxchain_read(struct file *file, 1037 char __user *user_buf, 1038 size_t count, loff_t *ppos) 1039 { 1040 struct iwl_mvm *mvm = file->private_data; 1041 int pos = 0; 1042 char buf[32]; 1043 const size_t bufsz = sizeof(buf); 1044 1045 /* print which antennas were set for the scan command by the user */ 1046 pos += scnprintf(buf + pos, bufsz - pos, "Antennas for scan: "); 1047 if (mvm->scan_rx_ant & ANT_A) 1048 pos += scnprintf(buf + pos, bufsz - pos, "A"); 1049 if (mvm->scan_rx_ant & ANT_B) 1050 pos += scnprintf(buf + pos, bufsz - pos, "B"); 1051 if (mvm->scan_rx_ant & ANT_C) 1052 pos += scnprintf(buf + pos, bufsz - pos, "C"); 1053 pos += scnprintf(buf + pos, bufsz - pos, " (%hhx)\n", mvm->scan_rx_ant); 1054 1055 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1056 } 1057 1058 static ssize_t 1059 iwl_dbgfs_scan_ant_rxchain_write(struct iwl_mvm *mvm, char *buf, 1060 size_t count, loff_t *ppos) 1061 { 1062 u8 scan_rx_ant; 1063 1064 if (!iwl_mvm_firmware_running(mvm)) 1065 return -EIO; 1066 1067 if (sscanf(buf, "%hhx", &scan_rx_ant) != 1) 1068 return -EINVAL; 1069 if (scan_rx_ant > ANT_ABC) 1070 return -EINVAL; 1071 if (scan_rx_ant & ~(iwl_mvm_get_valid_rx_ant(mvm))) 1072 return -EINVAL; 1073 1074 if (mvm->scan_rx_ant != scan_rx_ant) { 1075 mvm->scan_rx_ant = scan_rx_ant; 1076 if (fw_has_capa(&mvm->fw->ucode_capa, 1077 IWL_UCODE_TLV_CAPA_UMAC_SCAN)) 1078 iwl_mvm_config_scan(mvm); 1079 } 1080 1081 return count; 1082 } 1083 1084 static ssize_t iwl_dbgfs_indirection_tbl_write(struct iwl_mvm *mvm, 1085 char *buf, size_t count, 1086 loff_t *ppos) 1087 { 1088 struct iwl_rss_config_cmd cmd = { 1089 .flags = cpu_to_le32(IWL_RSS_ENABLE), 1090 .hash_mask = IWL_RSS_HASH_TYPE_IPV4_TCP | 1091 IWL_RSS_HASH_TYPE_IPV4_UDP | 1092 IWL_RSS_HASH_TYPE_IPV4_PAYLOAD | 1093 IWL_RSS_HASH_TYPE_IPV6_TCP | 1094 IWL_RSS_HASH_TYPE_IPV6_UDP | 1095 IWL_RSS_HASH_TYPE_IPV6_PAYLOAD, 1096 }; 1097 int ret, i, num_repeats, nbytes = count / 2; 1098 1099 ret = hex2bin(cmd.indirection_table, buf, nbytes); 1100 if (ret) 1101 return ret; 1102 1103 /* 1104 * The input is the redirection table, partial or full. 1105 * Repeat the pattern if needed. 1106 * For example, input of 01020F will be repeated 42 times, 1107 * indirecting RSS hash results to queues 1, 2, 15 (skipping 1108 * queues 3 - 14). 1109 */ 1110 num_repeats = ARRAY_SIZE(cmd.indirection_table) / nbytes; 1111 for (i = 1; i < num_repeats; i++) 1112 memcpy(&cmd.indirection_table[i * nbytes], 1113 cmd.indirection_table, nbytes); 1114 /* handle cut in the middle pattern for the last places */ 1115 memcpy(&cmd.indirection_table[i * nbytes], cmd.indirection_table, 1116 ARRAY_SIZE(cmd.indirection_table) % nbytes); 1117 1118 netdev_rss_key_fill(cmd.secret_key, sizeof(cmd.secret_key)); 1119 1120 mutex_lock(&mvm->mutex); 1121 if (iwl_mvm_firmware_running(mvm)) 1122 ret = iwl_mvm_send_cmd_pdu(mvm, RSS_CONFIG_CMD, 0, 1123 sizeof(cmd), &cmd); 1124 else 1125 ret = 0; 1126 mutex_unlock(&mvm->mutex); 1127 1128 return ret ?: count; 1129 } 1130 1131 static ssize_t iwl_dbgfs_inject_packet_write(struct iwl_mvm *mvm, 1132 char *buf, size_t count, 1133 loff_t *ppos) 1134 { 1135 struct iwl_rx_cmd_buffer rxb = { 1136 ._rx_page_order = 0, 1137 .truesize = 0, /* not used */ 1138 ._offset = 0, 1139 }; 1140 struct iwl_rx_packet *pkt; 1141 struct iwl_rx_mpdu_desc *desc; 1142 int bin_len = count / 2; 1143 int ret = -EINVAL; 1144 size_t mpdu_cmd_hdr_size = 1145 (mvm->trans->cfg->device_family >= IWL_DEVICE_FAMILY_22560) ? 1146 sizeof(struct iwl_rx_mpdu_desc) : 1147 IWL_RX_DESC_SIZE_V1; 1148 1149 if (!iwl_mvm_firmware_running(mvm)) 1150 return -EIO; 1151 1152 /* supporting only 9000 descriptor */ 1153 if (!mvm->trans->cfg->mq_rx_supported) 1154 return -ENOTSUPP; 1155 1156 rxb._page = alloc_pages(GFP_ATOMIC, 0); 1157 if (!rxb._page) 1158 return -ENOMEM; 1159 pkt = rxb_addr(&rxb); 1160 1161 ret = hex2bin(page_address(rxb._page), buf, bin_len); 1162 if (ret) 1163 goto out; 1164 1165 /* avoid invalid memory access */ 1166 if (bin_len < sizeof(*pkt) + mpdu_cmd_hdr_size) 1167 goto out; 1168 1169 /* check this is RX packet */ 1170 if (WIDE_ID(pkt->hdr.group_id, pkt->hdr.cmd) != 1171 WIDE_ID(LEGACY_GROUP, REPLY_RX_MPDU_CMD)) 1172 goto out; 1173 1174 /* check the length in metadata matches actual received length */ 1175 desc = (void *)pkt->data; 1176 if (le16_to_cpu(desc->mpdu_len) != 1177 (bin_len - mpdu_cmd_hdr_size - sizeof(*pkt))) 1178 goto out; 1179 1180 local_bh_disable(); 1181 iwl_mvm_rx_mpdu_mq(mvm, NULL, &rxb, 0); 1182 local_bh_enable(); 1183 ret = 0; 1184 1185 out: 1186 iwl_free_rxb(&rxb); 1187 1188 return ret ?: count; 1189 } 1190 1191 static ssize_t iwl_dbgfs_fw_dbg_conf_read(struct file *file, 1192 char __user *user_buf, 1193 size_t count, loff_t *ppos) 1194 { 1195 struct iwl_mvm *mvm = file->private_data; 1196 int conf; 1197 char buf[8]; 1198 const size_t bufsz = sizeof(buf); 1199 int pos = 0; 1200 1201 mutex_lock(&mvm->mutex); 1202 conf = mvm->fwrt.dump.conf; 1203 mutex_unlock(&mvm->mutex); 1204 1205 pos += scnprintf(buf + pos, bufsz - pos, "%d\n", conf); 1206 1207 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1208 } 1209 1210 static ssize_t iwl_dbgfs_fw_dbg_conf_write(struct iwl_mvm *mvm, 1211 char *buf, size_t count, 1212 loff_t *ppos) 1213 { 1214 unsigned int conf_id; 1215 int ret; 1216 1217 if (!iwl_mvm_firmware_running(mvm)) 1218 return -EIO; 1219 1220 ret = kstrtouint(buf, 0, &conf_id); 1221 if (ret) 1222 return ret; 1223 1224 if (WARN_ON(conf_id >= FW_DBG_CONF_MAX)) 1225 return -EINVAL; 1226 1227 mutex_lock(&mvm->mutex); 1228 ret = iwl_fw_start_dbg_conf(&mvm->fwrt, conf_id); 1229 mutex_unlock(&mvm->mutex); 1230 1231 return ret ?: count; 1232 } 1233 1234 static ssize_t iwl_dbgfs_fw_dbg_collect_write(struct iwl_mvm *mvm, 1235 char *buf, size_t count, 1236 loff_t *ppos) 1237 { 1238 int ret; 1239 1240 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PRPH_WRITE); 1241 if (ret) 1242 return ret; 1243 if (count == 0) 1244 return 0; 1245 1246 iwl_fw_dbg_collect(&mvm->fwrt, FW_DBG_TRIGGER_USER, buf, 1247 (count - 1)); 1248 1249 iwl_mvm_unref(mvm, IWL_MVM_REF_PRPH_WRITE); 1250 1251 return count; 1252 } 1253 1254 static ssize_t iwl_dbgfs_max_amsdu_len_write(struct iwl_mvm *mvm, 1255 char *buf, size_t count, 1256 loff_t *ppos) 1257 { 1258 unsigned int max_amsdu_len; 1259 int ret; 1260 1261 ret = kstrtouint(buf, 0, &max_amsdu_len); 1262 if (ret) 1263 return ret; 1264 1265 if (max_amsdu_len > IEEE80211_MAX_MPDU_LEN_VHT_11454) 1266 return -EINVAL; 1267 mvm->max_amsdu_len = max_amsdu_len; 1268 1269 return count; 1270 } 1271 1272 #define ADD_TEXT(...) pos += scnprintf(buf + pos, bufsz - pos, __VA_ARGS__) 1273 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING 1274 static ssize_t iwl_dbgfs_bcast_filters_read(struct file *file, 1275 char __user *user_buf, 1276 size_t count, loff_t *ppos) 1277 { 1278 struct iwl_mvm *mvm = file->private_data; 1279 struct iwl_bcast_filter_cmd cmd; 1280 const struct iwl_fw_bcast_filter *filter; 1281 char *buf; 1282 int bufsz = 1024; 1283 int i, j, pos = 0; 1284 ssize_t ret; 1285 1286 buf = kzalloc(bufsz, GFP_KERNEL); 1287 if (!buf) 1288 return -ENOMEM; 1289 1290 mutex_lock(&mvm->mutex); 1291 if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) { 1292 ADD_TEXT("None\n"); 1293 mutex_unlock(&mvm->mutex); 1294 goto out; 1295 } 1296 mutex_unlock(&mvm->mutex); 1297 1298 for (i = 0; cmd.filters[i].attrs[0].mask; i++) { 1299 filter = &cmd.filters[i]; 1300 1301 ADD_TEXT("Filter [%d]:\n", i); 1302 ADD_TEXT("\tDiscard=%d\n", filter->discard); 1303 ADD_TEXT("\tFrame Type: %s\n", 1304 filter->frame_type ? "IPv4" : "Generic"); 1305 1306 for (j = 0; j < ARRAY_SIZE(filter->attrs); j++) { 1307 const struct iwl_fw_bcast_filter_attr *attr; 1308 1309 attr = &filter->attrs[j]; 1310 if (!attr->mask) 1311 break; 1312 1313 ADD_TEXT("\tAttr [%d]: offset=%d (from %s), mask=0x%x, value=0x%x reserved=0x%x\n", 1314 j, attr->offset, 1315 attr->offset_type ? "IP End" : 1316 "Payload Start", 1317 be32_to_cpu(attr->mask), 1318 be32_to_cpu(attr->val), 1319 le16_to_cpu(attr->reserved1)); 1320 } 1321 } 1322 out: 1323 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1324 kfree(buf); 1325 return ret; 1326 } 1327 1328 static ssize_t iwl_dbgfs_bcast_filters_write(struct iwl_mvm *mvm, char *buf, 1329 size_t count, loff_t *ppos) 1330 { 1331 int pos, next_pos; 1332 struct iwl_fw_bcast_filter filter = {}; 1333 struct iwl_bcast_filter_cmd cmd; 1334 u32 filter_id, attr_id, mask, value; 1335 int err = 0; 1336 1337 if (sscanf(buf, "%d %hhi %hhi %n", &filter_id, &filter.discard, 1338 &filter.frame_type, &pos) != 3) 1339 return -EINVAL; 1340 1341 if (filter_id >= ARRAY_SIZE(mvm->dbgfs_bcast_filtering.cmd.filters) || 1342 filter.frame_type > BCAST_FILTER_FRAME_TYPE_IPV4) 1343 return -EINVAL; 1344 1345 for (attr_id = 0; attr_id < ARRAY_SIZE(filter.attrs); 1346 attr_id++) { 1347 struct iwl_fw_bcast_filter_attr *attr = 1348 &filter.attrs[attr_id]; 1349 1350 if (pos >= count) 1351 break; 1352 1353 if (sscanf(&buf[pos], "%hhi %hhi %i %i %n", 1354 &attr->offset, &attr->offset_type, 1355 &mask, &value, &next_pos) != 4) 1356 return -EINVAL; 1357 1358 attr->mask = cpu_to_be32(mask); 1359 attr->val = cpu_to_be32(value); 1360 if (mask) 1361 filter.num_attrs++; 1362 1363 pos += next_pos; 1364 } 1365 1366 mutex_lock(&mvm->mutex); 1367 memcpy(&mvm->dbgfs_bcast_filtering.cmd.filters[filter_id], 1368 &filter, sizeof(filter)); 1369 1370 /* send updated bcast filtering configuration */ 1371 if (iwl_mvm_firmware_running(mvm) && 1372 mvm->dbgfs_bcast_filtering.override && 1373 iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) 1374 err = iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0, 1375 sizeof(cmd), &cmd); 1376 mutex_unlock(&mvm->mutex); 1377 1378 return err ?: count; 1379 } 1380 1381 static ssize_t iwl_dbgfs_bcast_filters_macs_read(struct file *file, 1382 char __user *user_buf, 1383 size_t count, loff_t *ppos) 1384 { 1385 struct iwl_mvm *mvm = file->private_data; 1386 struct iwl_bcast_filter_cmd cmd; 1387 char *buf; 1388 int bufsz = 1024; 1389 int i, pos = 0; 1390 ssize_t ret; 1391 1392 buf = kzalloc(bufsz, GFP_KERNEL); 1393 if (!buf) 1394 return -ENOMEM; 1395 1396 mutex_lock(&mvm->mutex); 1397 if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) { 1398 ADD_TEXT("None\n"); 1399 mutex_unlock(&mvm->mutex); 1400 goto out; 1401 } 1402 mutex_unlock(&mvm->mutex); 1403 1404 for (i = 0; i < ARRAY_SIZE(cmd.macs); i++) { 1405 const struct iwl_fw_bcast_mac *mac = &cmd.macs[i]; 1406 1407 ADD_TEXT("Mac [%d]: discard=%d attached_filters=0x%x\n", 1408 i, mac->default_discard, mac->attached_filters); 1409 } 1410 out: 1411 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1412 kfree(buf); 1413 return ret; 1414 } 1415 1416 static ssize_t iwl_dbgfs_bcast_filters_macs_write(struct iwl_mvm *mvm, 1417 char *buf, size_t count, 1418 loff_t *ppos) 1419 { 1420 struct iwl_bcast_filter_cmd cmd; 1421 struct iwl_fw_bcast_mac mac = {}; 1422 u32 mac_id, attached_filters; 1423 int err = 0; 1424 1425 if (!mvm->bcast_filters) 1426 return -ENOENT; 1427 1428 if (sscanf(buf, "%d %hhi %i", &mac_id, &mac.default_discard, 1429 &attached_filters) != 3) 1430 return -EINVAL; 1431 1432 if (mac_id >= ARRAY_SIZE(cmd.macs) || 1433 mac.default_discard > 1 || 1434 attached_filters >= BIT(ARRAY_SIZE(cmd.filters))) 1435 return -EINVAL; 1436 1437 mac.attached_filters = cpu_to_le16(attached_filters); 1438 1439 mutex_lock(&mvm->mutex); 1440 memcpy(&mvm->dbgfs_bcast_filtering.cmd.macs[mac_id], 1441 &mac, sizeof(mac)); 1442 1443 /* send updated bcast filtering configuration */ 1444 if (iwl_mvm_firmware_running(mvm) && 1445 mvm->dbgfs_bcast_filtering.override && 1446 iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) 1447 err = iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0, 1448 sizeof(cmd), &cmd); 1449 mutex_unlock(&mvm->mutex); 1450 1451 return err ?: count; 1452 } 1453 #endif 1454 1455 #ifdef CONFIG_PM_SLEEP 1456 static ssize_t iwl_dbgfs_d3_sram_write(struct iwl_mvm *mvm, char *buf, 1457 size_t count, loff_t *ppos) 1458 { 1459 int store; 1460 1461 if (sscanf(buf, "%d", &store) != 1) 1462 return -EINVAL; 1463 1464 mvm->store_d3_resume_sram = store; 1465 1466 return count; 1467 } 1468 1469 static ssize_t iwl_dbgfs_d3_sram_read(struct file *file, char __user *user_buf, 1470 size_t count, loff_t *ppos) 1471 { 1472 struct iwl_mvm *mvm = file->private_data; 1473 const struct fw_img *img; 1474 int ofs, len, pos = 0; 1475 size_t bufsz, ret; 1476 char *buf; 1477 u8 *ptr = mvm->d3_resume_sram; 1478 1479 img = &mvm->fw->img[IWL_UCODE_WOWLAN]; 1480 len = img->sec[IWL_UCODE_SECTION_DATA].len; 1481 1482 bufsz = len * 4 + 256; 1483 buf = kzalloc(bufsz, GFP_KERNEL); 1484 if (!buf) 1485 return -ENOMEM; 1486 1487 pos += scnprintf(buf, bufsz, "D3 SRAM capture: %sabled\n", 1488 mvm->store_d3_resume_sram ? "en" : "dis"); 1489 1490 if (ptr) { 1491 for (ofs = 0; ofs < len; ofs += 16) { 1492 pos += scnprintf(buf + pos, bufsz - pos, 1493 "0x%.4x %16ph\n", ofs, ptr + ofs); 1494 } 1495 } else { 1496 pos += scnprintf(buf + pos, bufsz - pos, 1497 "(no data captured)\n"); 1498 } 1499 1500 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1501 1502 kfree(buf); 1503 1504 return ret; 1505 } 1506 #endif 1507 1508 #define PRINT_MVM_REF(ref) do { \ 1509 if (mvm->refs[ref]) \ 1510 pos += scnprintf(buf + pos, bufsz - pos, \ 1511 "\t(0x%lx): %d %s\n", \ 1512 BIT(ref), mvm->refs[ref], #ref); \ 1513 } while (0) 1514 1515 static ssize_t iwl_dbgfs_d0i3_refs_read(struct file *file, 1516 char __user *user_buf, 1517 size_t count, loff_t *ppos) 1518 { 1519 struct iwl_mvm *mvm = file->private_data; 1520 int i, pos = 0; 1521 char buf[256]; 1522 const size_t bufsz = sizeof(buf); 1523 u32 refs = 0; 1524 1525 for (i = 0; i < IWL_MVM_REF_COUNT; i++) 1526 if (mvm->refs[i]) 1527 refs |= BIT(i); 1528 1529 pos += scnprintf(buf + pos, bufsz - pos, "taken mvm refs: 0x%x\n", 1530 refs); 1531 1532 PRINT_MVM_REF(IWL_MVM_REF_UCODE_DOWN); 1533 PRINT_MVM_REF(IWL_MVM_REF_SCAN); 1534 PRINT_MVM_REF(IWL_MVM_REF_ROC); 1535 PRINT_MVM_REF(IWL_MVM_REF_ROC_AUX); 1536 PRINT_MVM_REF(IWL_MVM_REF_P2P_CLIENT); 1537 PRINT_MVM_REF(IWL_MVM_REF_AP_IBSS); 1538 PRINT_MVM_REF(IWL_MVM_REF_USER); 1539 PRINT_MVM_REF(IWL_MVM_REF_TX); 1540 PRINT_MVM_REF(IWL_MVM_REF_TX_AGG); 1541 PRINT_MVM_REF(IWL_MVM_REF_ADD_IF); 1542 PRINT_MVM_REF(IWL_MVM_REF_START_AP); 1543 PRINT_MVM_REF(IWL_MVM_REF_BSS_CHANGED); 1544 PRINT_MVM_REF(IWL_MVM_REF_PREPARE_TX); 1545 PRINT_MVM_REF(IWL_MVM_REF_PROTECT_TDLS); 1546 PRINT_MVM_REF(IWL_MVM_REF_CHECK_CTKILL); 1547 PRINT_MVM_REF(IWL_MVM_REF_PRPH_READ); 1548 PRINT_MVM_REF(IWL_MVM_REF_PRPH_WRITE); 1549 PRINT_MVM_REF(IWL_MVM_REF_NMI); 1550 PRINT_MVM_REF(IWL_MVM_REF_TM_CMD); 1551 PRINT_MVM_REF(IWL_MVM_REF_EXIT_WORK); 1552 PRINT_MVM_REF(IWL_MVM_REF_PROTECT_CSA); 1553 PRINT_MVM_REF(IWL_MVM_REF_FW_DBG_COLLECT); 1554 PRINT_MVM_REF(IWL_MVM_REF_INIT_UCODE); 1555 PRINT_MVM_REF(IWL_MVM_REF_SENDING_CMD); 1556 PRINT_MVM_REF(IWL_MVM_REF_RX); 1557 1558 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1559 } 1560 1561 static ssize_t iwl_dbgfs_d0i3_refs_write(struct iwl_mvm *mvm, char *buf, 1562 size_t count, loff_t *ppos) 1563 { 1564 unsigned long value; 1565 int ret; 1566 bool taken; 1567 1568 ret = kstrtoul(buf, 10, &value); 1569 if (ret < 0) 1570 return ret; 1571 1572 mutex_lock(&mvm->mutex); 1573 1574 taken = mvm->refs[IWL_MVM_REF_USER]; 1575 if (value == 1 && !taken) 1576 iwl_mvm_ref(mvm, IWL_MVM_REF_USER); 1577 else if (value == 0 && taken) 1578 iwl_mvm_unref(mvm, IWL_MVM_REF_USER); 1579 else 1580 ret = -EINVAL; 1581 1582 mutex_unlock(&mvm->mutex); 1583 1584 if (ret < 0) 1585 return ret; 1586 return count; 1587 } 1588 1589 #define MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz) \ 1590 _MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz, struct iwl_mvm) 1591 #define MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz) \ 1592 _MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz, struct iwl_mvm) 1593 #define MVM_DEBUGFS_ADD_FILE_ALIAS(alias, name, parent, mode) do { \ 1594 if (!debugfs_create_file(alias, mode, parent, mvm, \ 1595 &iwl_dbgfs_##name##_ops)) \ 1596 goto err; \ 1597 } while (0) 1598 #define MVM_DEBUGFS_ADD_FILE(name, parent, mode) \ 1599 MVM_DEBUGFS_ADD_FILE_ALIAS(#name, name, parent, mode) 1600 1601 #define MVM_DEBUGFS_WRITE_STA_FILE_OPS(name, bufsz) \ 1602 _MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz, struct ieee80211_sta) 1603 #define MVM_DEBUGFS_READ_WRITE_STA_FILE_OPS(name, bufsz) \ 1604 _MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz, struct ieee80211_sta) 1605 1606 #define MVM_DEBUGFS_ADD_STA_FILE_ALIAS(alias, name, parent, mode) do { \ 1607 if (!debugfs_create_file(alias, mode, parent, sta, \ 1608 &iwl_dbgfs_##name##_ops)) \ 1609 goto err; \ 1610 } while (0) 1611 #define MVM_DEBUGFS_ADD_STA_FILE(name, parent, mode) \ 1612 MVM_DEBUGFS_ADD_STA_FILE_ALIAS(#name, name, parent, mode) 1613 1614 static ssize_t 1615 iwl_dbgfs_prph_reg_read(struct file *file, 1616 char __user *user_buf, 1617 size_t count, loff_t *ppos) 1618 { 1619 struct iwl_mvm *mvm = file->private_data; 1620 int pos = 0; 1621 char buf[32]; 1622 const size_t bufsz = sizeof(buf); 1623 int ret; 1624 1625 if (!mvm->dbgfs_prph_reg_addr) 1626 return -EINVAL; 1627 1628 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PRPH_READ); 1629 if (ret) 1630 return ret; 1631 1632 pos += scnprintf(buf + pos, bufsz - pos, "Reg 0x%x: (0x%x)\n", 1633 mvm->dbgfs_prph_reg_addr, 1634 iwl_read_prph(mvm->trans, mvm->dbgfs_prph_reg_addr)); 1635 1636 iwl_mvm_unref(mvm, IWL_MVM_REF_PRPH_READ); 1637 1638 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1639 } 1640 1641 static ssize_t 1642 iwl_dbgfs_prph_reg_write(struct iwl_mvm *mvm, char *buf, 1643 size_t count, loff_t *ppos) 1644 { 1645 u8 args; 1646 u32 value; 1647 int ret; 1648 1649 args = sscanf(buf, "%i %i", &mvm->dbgfs_prph_reg_addr, &value); 1650 /* if we only want to set the reg address - nothing more to do */ 1651 if (args == 1) 1652 goto out; 1653 1654 /* otherwise, make sure we have both address and value */ 1655 if (args != 2) 1656 return -EINVAL; 1657 1658 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PRPH_WRITE); 1659 if (ret) 1660 return ret; 1661 1662 iwl_write_prph(mvm->trans, mvm->dbgfs_prph_reg_addr, value); 1663 1664 iwl_mvm_unref(mvm, IWL_MVM_REF_PRPH_WRITE); 1665 out: 1666 return count; 1667 } 1668 1669 static ssize_t 1670 iwl_dbgfs_send_echo_cmd_write(struct iwl_mvm *mvm, char *buf, 1671 size_t count, loff_t *ppos) 1672 { 1673 int ret; 1674 1675 if (!iwl_mvm_firmware_running(mvm)) 1676 return -EIO; 1677 1678 mutex_lock(&mvm->mutex); 1679 ret = iwl_mvm_send_cmd_pdu(mvm, ECHO_CMD, 0, 0, NULL); 1680 mutex_unlock(&mvm->mutex); 1681 1682 return ret ?: count; 1683 } 1684 1685 static ssize_t 1686 iwl_dbgfs_he_sniffer_params_write(struct iwl_mvm *mvm, char *buf, 1687 size_t count, loff_t *ppos) 1688 { 1689 struct iwl_he_monitor_cmd he_mon_cmd = {}; 1690 u32 aid; 1691 int ret; 1692 1693 if (!iwl_mvm_firmware_running(mvm)) 1694 return -EIO; 1695 1696 ret = sscanf(buf, "%x %2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx", &aid, 1697 &he_mon_cmd.bssid[0], &he_mon_cmd.bssid[1], 1698 &he_mon_cmd.bssid[2], &he_mon_cmd.bssid[3], 1699 &he_mon_cmd.bssid[4], &he_mon_cmd.bssid[5]); 1700 if (ret != 7) 1701 return -EINVAL; 1702 1703 he_mon_cmd.aid = cpu_to_le16(aid); 1704 1705 mutex_lock(&mvm->mutex); 1706 ret = iwl_mvm_send_cmd_pdu(mvm, iwl_cmd_id(HE_AIR_SNIFFER_CONFIG_CMD, 1707 DATA_PATH_GROUP, 0), 0, 1708 sizeof(he_mon_cmd), &he_mon_cmd); 1709 mutex_unlock(&mvm->mutex); 1710 1711 return ret ?: count; 1712 } 1713 1714 static ssize_t 1715 iwl_dbgfs_uapsd_noagg_bssids_read(struct file *file, char __user *user_buf, 1716 size_t count, loff_t *ppos) 1717 { 1718 struct iwl_mvm *mvm = file->private_data; 1719 u8 buf[IWL_MVM_UAPSD_NOAGG_BSSIDS_NUM * ETH_ALEN * 3 + 1]; 1720 unsigned int pos = 0; 1721 size_t bufsz = sizeof(buf); 1722 int i; 1723 1724 mutex_lock(&mvm->mutex); 1725 1726 for (i = 0; i < IWL_MVM_UAPSD_NOAGG_LIST_LEN; i++) 1727 pos += scnprintf(buf + pos, bufsz - pos, "%pM\n", 1728 mvm->uapsd_noagg_bssids[i].addr); 1729 1730 mutex_unlock(&mvm->mutex); 1731 1732 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1733 } 1734 1735 MVM_DEBUGFS_READ_WRITE_FILE_OPS(prph_reg, 64); 1736 1737 /* Device wide debugfs entries */ 1738 MVM_DEBUGFS_READ_FILE_OPS(ctdp_budget); 1739 MVM_DEBUGFS_WRITE_FILE_OPS(stop_ctdp, 8); 1740 MVM_DEBUGFS_WRITE_FILE_OPS(force_ctkill, 8); 1741 MVM_DEBUGFS_WRITE_FILE_OPS(tx_flush, 16); 1742 MVM_DEBUGFS_WRITE_FILE_OPS(sta_drain, 8); 1743 MVM_DEBUGFS_WRITE_FILE_OPS(send_echo_cmd, 8); 1744 MVM_DEBUGFS_READ_WRITE_FILE_OPS(sram, 64); 1745 MVM_DEBUGFS_READ_WRITE_FILE_OPS(set_nic_temperature, 64); 1746 MVM_DEBUGFS_READ_FILE_OPS(nic_temp); 1747 MVM_DEBUGFS_READ_FILE_OPS(stations); 1748 MVM_DEBUGFS_READ_FILE_OPS(rs_data); 1749 MVM_DEBUGFS_READ_FILE_OPS(bt_notif); 1750 MVM_DEBUGFS_READ_FILE_OPS(bt_cmd); 1751 MVM_DEBUGFS_READ_WRITE_FILE_OPS(disable_power_off, 64); 1752 MVM_DEBUGFS_READ_FILE_OPS(fw_rx_stats); 1753 MVM_DEBUGFS_READ_FILE_OPS(drv_rx_stats); 1754 MVM_DEBUGFS_READ_FILE_OPS(fw_ver); 1755 MVM_DEBUGFS_WRITE_FILE_OPS(fw_restart, 10); 1756 MVM_DEBUGFS_WRITE_FILE_OPS(fw_nmi, 10); 1757 MVM_DEBUGFS_WRITE_FILE_OPS(bt_tx_prio, 10); 1758 MVM_DEBUGFS_WRITE_FILE_OPS(bt_force_ant, 10); 1759 MVM_DEBUGFS_READ_WRITE_FILE_OPS(scan_ant_rxchain, 8); 1760 MVM_DEBUGFS_READ_WRITE_FILE_OPS(d0i3_refs, 8); 1761 MVM_DEBUGFS_READ_WRITE_FILE_OPS(fw_dbg_conf, 8); 1762 MVM_DEBUGFS_WRITE_FILE_OPS(fw_dbg_collect, 64); 1763 MVM_DEBUGFS_WRITE_FILE_OPS(max_amsdu_len, 8); 1764 MVM_DEBUGFS_WRITE_FILE_OPS(indirection_tbl, 1765 (IWL_RSS_INDIRECTION_TABLE_SIZE * 2)); 1766 MVM_DEBUGFS_WRITE_FILE_OPS(inject_packet, 512); 1767 1768 MVM_DEBUGFS_READ_FILE_OPS(uapsd_noagg_bssids); 1769 1770 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING 1771 MVM_DEBUGFS_READ_WRITE_FILE_OPS(bcast_filters, 256); 1772 MVM_DEBUGFS_READ_WRITE_FILE_OPS(bcast_filters_macs, 256); 1773 #endif 1774 1775 #ifdef CONFIG_PM_SLEEP 1776 MVM_DEBUGFS_READ_WRITE_FILE_OPS(d3_sram, 8); 1777 #endif 1778 #ifdef CONFIG_ACPI 1779 MVM_DEBUGFS_READ_FILE_OPS(sar_geo_profile); 1780 #endif 1781 1782 MVM_DEBUGFS_WRITE_FILE_OPS(he_sniffer_params, 32); 1783 1784 static ssize_t iwl_dbgfs_mem_read(struct file *file, char __user *user_buf, 1785 size_t count, loff_t *ppos) 1786 { 1787 struct iwl_mvm *mvm = file->private_data; 1788 struct iwl_dbg_mem_access_cmd cmd = {}; 1789 struct iwl_dbg_mem_access_rsp *rsp; 1790 struct iwl_host_cmd hcmd = { 1791 .flags = CMD_WANT_SKB | CMD_SEND_IN_RFKILL, 1792 .data = { &cmd, }, 1793 .len = { sizeof(cmd) }, 1794 }; 1795 size_t delta; 1796 ssize_t ret, len; 1797 1798 if (!iwl_mvm_firmware_running(mvm)) 1799 return -EIO; 1800 1801 hcmd.id = iwl_cmd_id(*ppos >> 24 ? UMAC_RD_WR : LMAC_RD_WR, 1802 DEBUG_GROUP, 0); 1803 cmd.op = cpu_to_le32(DEBUG_MEM_OP_READ); 1804 1805 /* Take care of alignment of both the position and the length */ 1806 delta = *ppos & 0x3; 1807 cmd.addr = cpu_to_le32(*ppos - delta); 1808 cmd.len = cpu_to_le32(min(ALIGN(count + delta, 4) / 4, 1809 (size_t)DEBUG_MEM_MAX_SIZE_DWORDS)); 1810 1811 mutex_lock(&mvm->mutex); 1812 ret = iwl_mvm_send_cmd(mvm, &hcmd); 1813 mutex_unlock(&mvm->mutex); 1814 1815 if (ret < 0) 1816 return ret; 1817 1818 rsp = (void *)hcmd.resp_pkt->data; 1819 if (le32_to_cpu(rsp->status) != DEBUG_MEM_STATUS_SUCCESS) { 1820 ret = -ENXIO; 1821 goto out; 1822 } 1823 1824 len = min((size_t)le32_to_cpu(rsp->len) << 2, 1825 iwl_rx_packet_payload_len(hcmd.resp_pkt) - sizeof(*rsp)); 1826 len = min(len - delta, count); 1827 if (len < 0) { 1828 ret = -EFAULT; 1829 goto out; 1830 } 1831 1832 ret = len - copy_to_user(user_buf, (void *)rsp->data + delta, len); 1833 *ppos += ret; 1834 1835 out: 1836 iwl_free_resp(&hcmd); 1837 return ret; 1838 } 1839 1840 static ssize_t iwl_dbgfs_mem_write(struct file *file, 1841 const char __user *user_buf, size_t count, 1842 loff_t *ppos) 1843 { 1844 struct iwl_mvm *mvm = file->private_data; 1845 struct iwl_dbg_mem_access_cmd *cmd; 1846 struct iwl_dbg_mem_access_rsp *rsp; 1847 struct iwl_host_cmd hcmd = {}; 1848 size_t cmd_size; 1849 size_t data_size; 1850 u32 op, len; 1851 ssize_t ret; 1852 1853 if (!iwl_mvm_firmware_running(mvm)) 1854 return -EIO; 1855 1856 hcmd.id = iwl_cmd_id(*ppos >> 24 ? UMAC_RD_WR : LMAC_RD_WR, 1857 DEBUG_GROUP, 0); 1858 1859 if (*ppos & 0x3 || count < 4) { 1860 op = DEBUG_MEM_OP_WRITE_BYTES; 1861 len = min(count, (size_t)(4 - (*ppos & 0x3))); 1862 data_size = len; 1863 } else { 1864 op = DEBUG_MEM_OP_WRITE; 1865 len = min(count >> 2, (size_t)DEBUG_MEM_MAX_SIZE_DWORDS); 1866 data_size = len << 2; 1867 } 1868 1869 cmd_size = sizeof(*cmd) + ALIGN(data_size, 4); 1870 cmd = kzalloc(cmd_size, GFP_KERNEL); 1871 if (!cmd) 1872 return -ENOMEM; 1873 1874 cmd->op = cpu_to_le32(op); 1875 cmd->len = cpu_to_le32(len); 1876 cmd->addr = cpu_to_le32(*ppos); 1877 if (copy_from_user((void *)cmd->data, user_buf, data_size)) { 1878 kfree(cmd); 1879 return -EFAULT; 1880 } 1881 1882 hcmd.flags = CMD_WANT_SKB | CMD_SEND_IN_RFKILL, 1883 hcmd.data[0] = (void *)cmd; 1884 hcmd.len[0] = cmd_size; 1885 1886 mutex_lock(&mvm->mutex); 1887 ret = iwl_mvm_send_cmd(mvm, &hcmd); 1888 mutex_unlock(&mvm->mutex); 1889 1890 kfree(cmd); 1891 1892 if (ret < 0) 1893 return ret; 1894 1895 rsp = (void *)hcmd.resp_pkt->data; 1896 if (rsp->status != DEBUG_MEM_STATUS_SUCCESS) { 1897 ret = -ENXIO; 1898 goto out; 1899 } 1900 1901 ret = data_size; 1902 *ppos += ret; 1903 1904 out: 1905 iwl_free_resp(&hcmd); 1906 return ret; 1907 } 1908 1909 static const struct file_operations iwl_dbgfs_mem_ops = { 1910 .read = iwl_dbgfs_mem_read, 1911 .write = iwl_dbgfs_mem_write, 1912 .open = simple_open, 1913 .llseek = default_llseek, 1914 }; 1915 1916 void iwl_mvm_sta_add_debugfs(struct ieee80211_hw *hw, 1917 struct ieee80211_vif *vif, 1918 struct ieee80211_sta *sta, 1919 struct dentry *dir) 1920 { 1921 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); 1922 1923 if (iwl_mvm_has_tlc_offload(mvm)) 1924 MVM_DEBUGFS_ADD_STA_FILE(rs_data, dir, 0400); 1925 1926 return; 1927 err: 1928 IWL_ERR(mvm, "Can't create the mvm station debugfs entry\n"); 1929 } 1930 1931 int iwl_mvm_dbgfs_register(struct iwl_mvm *mvm, struct dentry *dbgfs_dir) 1932 { 1933 struct dentry *bcast_dir __maybe_unused; 1934 char buf[100]; 1935 1936 spin_lock_init(&mvm->drv_stats_lock); 1937 1938 mvm->debugfs_dir = dbgfs_dir; 1939 1940 MVM_DEBUGFS_ADD_FILE(tx_flush, mvm->debugfs_dir, 0200); 1941 MVM_DEBUGFS_ADD_FILE(sta_drain, mvm->debugfs_dir, 0200); 1942 MVM_DEBUGFS_ADD_FILE(sram, mvm->debugfs_dir, 0600); 1943 MVM_DEBUGFS_ADD_FILE(set_nic_temperature, mvm->debugfs_dir, 0600); 1944 MVM_DEBUGFS_ADD_FILE(nic_temp, dbgfs_dir, 0400); 1945 MVM_DEBUGFS_ADD_FILE(ctdp_budget, dbgfs_dir, 0400); 1946 MVM_DEBUGFS_ADD_FILE(stop_ctdp, dbgfs_dir, 0200); 1947 MVM_DEBUGFS_ADD_FILE(force_ctkill, dbgfs_dir, 0200); 1948 MVM_DEBUGFS_ADD_FILE(stations, dbgfs_dir, 0400); 1949 MVM_DEBUGFS_ADD_FILE(bt_notif, dbgfs_dir, 0400); 1950 MVM_DEBUGFS_ADD_FILE(bt_cmd, dbgfs_dir, 0400); 1951 MVM_DEBUGFS_ADD_FILE(disable_power_off, mvm->debugfs_dir, 0600); 1952 MVM_DEBUGFS_ADD_FILE(fw_ver, mvm->debugfs_dir, 0400); 1953 MVM_DEBUGFS_ADD_FILE(fw_rx_stats, mvm->debugfs_dir, 0400); 1954 MVM_DEBUGFS_ADD_FILE(drv_rx_stats, mvm->debugfs_dir, 0400); 1955 MVM_DEBUGFS_ADD_FILE(fw_restart, mvm->debugfs_dir, 0200); 1956 MVM_DEBUGFS_ADD_FILE(fw_nmi, mvm->debugfs_dir, 0200); 1957 MVM_DEBUGFS_ADD_FILE(bt_tx_prio, mvm->debugfs_dir, 0200); 1958 MVM_DEBUGFS_ADD_FILE(bt_force_ant, mvm->debugfs_dir, 0200); 1959 MVM_DEBUGFS_ADD_FILE(scan_ant_rxchain, mvm->debugfs_dir, 0600); 1960 MVM_DEBUGFS_ADD_FILE(prph_reg, mvm->debugfs_dir, 0600); 1961 MVM_DEBUGFS_ADD_FILE(d0i3_refs, mvm->debugfs_dir, 0600); 1962 MVM_DEBUGFS_ADD_FILE(fw_dbg_conf, mvm->debugfs_dir, 0600); 1963 MVM_DEBUGFS_ADD_FILE(fw_dbg_collect, mvm->debugfs_dir, 0200); 1964 MVM_DEBUGFS_ADD_FILE(max_amsdu_len, mvm->debugfs_dir, 0200); 1965 MVM_DEBUGFS_ADD_FILE(send_echo_cmd, mvm->debugfs_dir, 0200); 1966 MVM_DEBUGFS_ADD_FILE(indirection_tbl, mvm->debugfs_dir, 0200); 1967 MVM_DEBUGFS_ADD_FILE(inject_packet, mvm->debugfs_dir, 0200); 1968 #ifdef CONFIG_ACPI 1969 MVM_DEBUGFS_ADD_FILE(sar_geo_profile, dbgfs_dir, 0400); 1970 #endif 1971 MVM_DEBUGFS_ADD_FILE(he_sniffer_params, mvm->debugfs_dir, 0200); 1972 1973 if (!debugfs_create_bool("enable_scan_iteration_notif", 1974 0600, 1975 mvm->debugfs_dir, 1976 &mvm->scan_iter_notif_enabled)) 1977 goto err; 1978 if (!debugfs_create_bool("drop_bcn_ap_mode", 0600, 1979 mvm->debugfs_dir, &mvm->drop_bcn_ap_mode)) 1980 goto err; 1981 1982 MVM_DEBUGFS_ADD_FILE(uapsd_noagg_bssids, mvm->debugfs_dir, S_IRUSR); 1983 1984 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING 1985 if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_BCAST_FILTERING) { 1986 bcast_dir = debugfs_create_dir("bcast_filtering", 1987 mvm->debugfs_dir); 1988 if (!bcast_dir) 1989 goto err; 1990 1991 if (!debugfs_create_bool("override", 0600, 1992 bcast_dir, 1993 &mvm->dbgfs_bcast_filtering.override)) 1994 goto err; 1995 1996 MVM_DEBUGFS_ADD_FILE_ALIAS("filters", bcast_filters, 1997 bcast_dir, 0600); 1998 MVM_DEBUGFS_ADD_FILE_ALIAS("macs", bcast_filters_macs, 1999 bcast_dir, 0600); 2000 } 2001 #endif 2002 2003 #ifdef CONFIG_PM_SLEEP 2004 MVM_DEBUGFS_ADD_FILE(d3_sram, mvm->debugfs_dir, 0600); 2005 MVM_DEBUGFS_ADD_FILE(d3_test, mvm->debugfs_dir, 0400); 2006 if (!debugfs_create_bool("d3_wake_sysassert", 0600, 2007 mvm->debugfs_dir, &mvm->d3_wake_sysassert)) 2008 goto err; 2009 if (!debugfs_create_u32("last_netdetect_scans", 0400, 2010 mvm->debugfs_dir, &mvm->last_netdetect_scans)) 2011 goto err; 2012 #endif 2013 2014 if (!debugfs_create_u8("ps_disabled", 0400, 2015 mvm->debugfs_dir, &mvm->ps_disabled)) 2016 goto err; 2017 if (!debugfs_create_blob("nvm_hw", 0400, 2018 mvm->debugfs_dir, &mvm->nvm_hw_blob)) 2019 goto err; 2020 if (!debugfs_create_blob("nvm_sw", 0400, 2021 mvm->debugfs_dir, &mvm->nvm_sw_blob)) 2022 goto err; 2023 if (!debugfs_create_blob("nvm_calib", 0400, 2024 mvm->debugfs_dir, &mvm->nvm_calib_blob)) 2025 goto err; 2026 if (!debugfs_create_blob("nvm_prod", 0400, 2027 mvm->debugfs_dir, &mvm->nvm_prod_blob)) 2028 goto err; 2029 if (!debugfs_create_blob("nvm_phy_sku", 0400, 2030 mvm->debugfs_dir, &mvm->nvm_phy_sku_blob)) 2031 goto err; 2032 if (!debugfs_create_blob("nvm_reg", S_IRUSR, 2033 mvm->debugfs_dir, &mvm->nvm_reg_blob)) 2034 goto err; 2035 2036 debugfs_create_file("mem", 0600, dbgfs_dir, mvm, &iwl_dbgfs_mem_ops); 2037 2038 /* 2039 * Create a symlink with mac80211. It will be removed when mac80211 2040 * exists (before the opmode exists which removes the target.) 2041 */ 2042 snprintf(buf, 100, "../../%pd2", dbgfs_dir->d_parent); 2043 if (!debugfs_create_symlink("iwlwifi", mvm->hw->wiphy->debugfsdir, buf)) 2044 goto err; 2045 2046 return 0; 2047 err: 2048 IWL_ERR(mvm, "Can't create the mvm debugfs directory\n"); 2049 return -ENOMEM; 2050 } 2051