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 Intel Deutschland GmbH 11 * 12 * This program is free software; you can redistribute it and/or modify 13 * it under the terms of version 2 of the GNU General Public License as 14 * published by the Free Software Foundation. 15 * 16 * This program is distributed in the hope that it will be useful, but 17 * WITHOUT ANY WARRANTY; without even the implied warranty of 18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 19 * General Public License for more details. 20 * 21 * You should have received a copy of the GNU General Public License 22 * along with this program; if not, write to the Free Software 23 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, 24 * USA 25 * 26 * The full GNU General Public License is included in this distribution 27 * in the file called COPYING. 28 * 29 * Contact Information: 30 * Intel Linux Wireless <linuxwifi@intel.com> 31 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 32 * 33 * BSD LICENSE 34 * 35 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. 36 * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH 37 * All rights reserved. 38 * 39 * Redistribution and use in source and binary forms, with or without 40 * modification, are permitted provided that the following conditions 41 * are met: 42 * 43 * * Redistributions of source code must retain the above copyright 44 * notice, this list of conditions and the following disclaimer. 45 * * Redistributions in binary form must reproduce the above copyright 46 * notice, this list of conditions and the following disclaimer in 47 * the documentation and/or other materials provided with the 48 * distribution. 49 * * Neither the name Intel Corporation nor the names of its 50 * contributors may be used to endorse or promote products derived 51 * from this software without specific prior written permission. 52 * 53 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 54 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 55 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 56 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 57 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 58 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 59 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 60 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 61 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 62 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 63 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 64 * 65 *****************************************************************************/ 66 #include <linux/vmalloc.h> 67 #include <linux/ieee80211.h> 68 #include <linux/netdevice.h> 69 70 #include "mvm.h" 71 #include "fw-dbg.h" 72 #include "sta.h" 73 #include "iwl-io.h" 74 #include "debugfs.h" 75 #include "iwl-fw-error-dump.h" 76 77 static ssize_t iwl_dbgfs_ctdp_budget_read(struct file *file, 78 char __user *user_buf, 79 size_t count, loff_t *ppos) 80 { 81 struct iwl_mvm *mvm = file->private_data; 82 char buf[16]; 83 int pos, budget; 84 85 if (!mvm->ucode_loaded || mvm->cur_ucode != IWL_UCODE_REGULAR) 86 return -EIO; 87 88 mutex_lock(&mvm->mutex); 89 budget = iwl_mvm_ctdp_command(mvm, CTDP_CMD_OPERATION_REPORT, 0); 90 mutex_unlock(&mvm->mutex); 91 92 if (budget < 0) 93 return budget; 94 95 pos = scnprintf(buf, sizeof(buf), "%d\n", budget); 96 97 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 98 } 99 100 static ssize_t iwl_dbgfs_stop_ctdp_write(struct iwl_mvm *mvm, char *buf, 101 size_t count, loff_t *ppos) 102 { 103 int ret; 104 105 if (!mvm->ucode_loaded || mvm->cur_ucode != IWL_UCODE_REGULAR) 106 return -EIO; 107 108 mutex_lock(&mvm->mutex); 109 ret = iwl_mvm_ctdp_command(mvm, CTDP_CMD_OPERATION_STOP, 0); 110 mutex_unlock(&mvm->mutex); 111 112 return ret ?: count; 113 } 114 115 static ssize_t iwl_dbgfs_tx_flush_write(struct iwl_mvm *mvm, char *buf, 116 size_t count, loff_t *ppos) 117 { 118 int ret; 119 u32 scd_q_msk; 120 121 if (!mvm->ucode_loaded || mvm->cur_ucode != IWL_UCODE_REGULAR) 122 return -EIO; 123 124 if (sscanf(buf, "%x", &scd_q_msk) != 1) 125 return -EINVAL; 126 127 IWL_ERR(mvm, "FLUSHING queues: scd_q_msk = 0x%x\n", scd_q_msk); 128 129 mutex_lock(&mvm->mutex); 130 ret = iwl_mvm_flush_tx_path(mvm, scd_q_msk, 0) ? : count; 131 mutex_unlock(&mvm->mutex); 132 133 return ret; 134 } 135 136 static ssize_t iwl_dbgfs_sta_drain_write(struct iwl_mvm *mvm, char *buf, 137 size_t count, loff_t *ppos) 138 { 139 struct iwl_mvm_sta *mvmsta; 140 int sta_id, drain, ret; 141 142 if (!mvm->ucode_loaded || mvm->cur_ucode != IWL_UCODE_REGULAR) 143 return -EIO; 144 145 if (sscanf(buf, "%d %d", &sta_id, &drain) != 2) 146 return -EINVAL; 147 if (sta_id < 0 || sta_id >= IWL_MVM_STATION_COUNT) 148 return -EINVAL; 149 if (drain < 0 || drain > 1) 150 return -EINVAL; 151 152 mutex_lock(&mvm->mutex); 153 154 mvmsta = iwl_mvm_sta_from_staid_protected(mvm, sta_id); 155 156 if (!mvmsta) 157 ret = -ENOENT; 158 else 159 ret = iwl_mvm_drain_sta(mvm, mvmsta, drain) ? : count; 160 161 mutex_unlock(&mvm->mutex); 162 163 return ret; 164 } 165 166 static ssize_t iwl_dbgfs_sram_read(struct file *file, char __user *user_buf, 167 size_t count, loff_t *ppos) 168 { 169 struct iwl_mvm *mvm = file->private_data; 170 const struct fw_img *img; 171 unsigned int ofs, len; 172 size_t ret; 173 u8 *ptr; 174 175 if (!mvm->ucode_loaded) 176 return -EINVAL; 177 178 /* default is to dump the entire data segment */ 179 img = &mvm->fw->img[mvm->cur_ucode]; 180 ofs = img->sec[IWL_UCODE_SECTION_DATA].offset; 181 len = img->sec[IWL_UCODE_SECTION_DATA].len; 182 183 if (mvm->dbgfs_sram_len) { 184 ofs = mvm->dbgfs_sram_offset; 185 len = mvm->dbgfs_sram_len; 186 } 187 188 ptr = kzalloc(len, GFP_KERNEL); 189 if (!ptr) 190 return -ENOMEM; 191 192 iwl_trans_read_mem_bytes(mvm->trans, ofs, ptr, len); 193 194 ret = simple_read_from_buffer(user_buf, count, ppos, ptr, len); 195 196 kfree(ptr); 197 198 return ret; 199 } 200 201 static ssize_t iwl_dbgfs_sram_write(struct iwl_mvm *mvm, char *buf, 202 size_t count, loff_t *ppos) 203 { 204 const struct fw_img *img; 205 u32 offset, len; 206 u32 img_offset, img_len; 207 208 if (!mvm->ucode_loaded) 209 return -EINVAL; 210 211 img = &mvm->fw->img[mvm->cur_ucode]; 212 img_offset = img->sec[IWL_UCODE_SECTION_DATA].offset; 213 img_len = img->sec[IWL_UCODE_SECTION_DATA].len; 214 215 if (sscanf(buf, "%x,%x", &offset, &len) == 2) { 216 if ((offset & 0x3) || (len & 0x3)) 217 return -EINVAL; 218 219 if (offset + len > img_offset + img_len) 220 return -EINVAL; 221 222 mvm->dbgfs_sram_offset = offset; 223 mvm->dbgfs_sram_len = len; 224 } else { 225 mvm->dbgfs_sram_offset = 0; 226 mvm->dbgfs_sram_len = 0; 227 } 228 229 return count; 230 } 231 232 static ssize_t iwl_dbgfs_set_nic_temperature_read(struct file *file, 233 char __user *user_buf, 234 size_t count, loff_t *ppos) 235 { 236 struct iwl_mvm *mvm = file->private_data; 237 char buf[16]; 238 int pos; 239 240 if (!mvm->temperature_test) 241 pos = scnprintf(buf , sizeof(buf), "disabled\n"); 242 else 243 pos = scnprintf(buf , sizeof(buf), "%d\n", mvm->temperature); 244 245 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 246 } 247 248 /* 249 * Set NIC Temperature 250 * Cause the driver to ignore the actual NIC temperature reported by the FW 251 * Enable: any value between IWL_MVM_DEBUG_SET_TEMPERATURE_MIN - 252 * IWL_MVM_DEBUG_SET_TEMPERATURE_MAX 253 * Disable: IWL_MVM_DEBUG_SET_TEMPERATURE_DISABLE 254 */ 255 static ssize_t iwl_dbgfs_set_nic_temperature_write(struct iwl_mvm *mvm, 256 char *buf, size_t count, 257 loff_t *ppos) 258 { 259 int temperature; 260 261 if (!mvm->ucode_loaded && !mvm->temperature_test) 262 return -EIO; 263 264 if (kstrtoint(buf, 10, &temperature)) 265 return -EINVAL; 266 /* not a legal temperature */ 267 if ((temperature > IWL_MVM_DEBUG_SET_TEMPERATURE_MAX && 268 temperature != IWL_MVM_DEBUG_SET_TEMPERATURE_DISABLE) || 269 temperature < IWL_MVM_DEBUG_SET_TEMPERATURE_MIN) 270 return -EINVAL; 271 272 mutex_lock(&mvm->mutex); 273 if (temperature == IWL_MVM_DEBUG_SET_TEMPERATURE_DISABLE) { 274 if (!mvm->temperature_test) 275 goto out; 276 277 mvm->temperature_test = false; 278 /* Since we can't read the temp while awake, just set 279 * it to zero until we get the next RX stats from the 280 * firmware. 281 */ 282 mvm->temperature = 0; 283 } else { 284 mvm->temperature_test = true; 285 mvm->temperature = temperature; 286 } 287 IWL_DEBUG_TEMP(mvm, "%sabling debug set temperature (temp = %d)\n", 288 mvm->temperature_test ? "En" : "Dis" , 289 mvm->temperature); 290 /* handle the temperature change */ 291 iwl_mvm_tt_handler(mvm); 292 293 out: 294 mutex_unlock(&mvm->mutex); 295 296 return count; 297 } 298 299 static ssize_t iwl_dbgfs_nic_temp_read(struct file *file, 300 char __user *user_buf, 301 size_t count, loff_t *ppos) 302 { 303 struct iwl_mvm *mvm = file->private_data; 304 char buf[16]; 305 int pos, ret; 306 s32 temp; 307 308 if (!mvm->ucode_loaded) 309 return -EIO; 310 311 mutex_lock(&mvm->mutex); 312 ret = iwl_mvm_get_temp(mvm, &temp); 313 mutex_unlock(&mvm->mutex); 314 315 if (ret) 316 return -EIO; 317 318 pos = scnprintf(buf , sizeof(buf), "%d\n", temp); 319 320 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 321 } 322 323 static ssize_t iwl_dbgfs_stations_read(struct file *file, char __user *user_buf, 324 size_t count, loff_t *ppos) 325 { 326 struct iwl_mvm *mvm = file->private_data; 327 struct ieee80211_sta *sta; 328 char buf[400]; 329 int i, pos = 0, bufsz = sizeof(buf); 330 331 mutex_lock(&mvm->mutex); 332 333 for (i = 0; i < IWL_MVM_STATION_COUNT; i++) { 334 pos += scnprintf(buf + pos, bufsz - pos, "%.2d: ", i); 335 sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[i], 336 lockdep_is_held(&mvm->mutex)); 337 if (!sta) 338 pos += scnprintf(buf + pos, bufsz - pos, "N/A\n"); 339 else if (IS_ERR(sta)) 340 pos += scnprintf(buf + pos, bufsz - pos, "%ld\n", 341 PTR_ERR(sta)); 342 else 343 pos += scnprintf(buf + pos, bufsz - pos, "%pM\n", 344 sta->addr); 345 } 346 347 mutex_unlock(&mvm->mutex); 348 349 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 350 } 351 352 static ssize_t iwl_dbgfs_disable_power_off_read(struct file *file, 353 char __user *user_buf, 354 size_t count, loff_t *ppos) 355 { 356 struct iwl_mvm *mvm = file->private_data; 357 char buf[64]; 358 int bufsz = sizeof(buf); 359 int pos = 0; 360 361 pos += scnprintf(buf+pos, bufsz-pos, "disable_power_off_d0=%d\n", 362 mvm->disable_power_off); 363 pos += scnprintf(buf+pos, bufsz-pos, "disable_power_off_d3=%d\n", 364 mvm->disable_power_off_d3); 365 366 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 367 } 368 369 static ssize_t iwl_dbgfs_disable_power_off_write(struct iwl_mvm *mvm, char *buf, 370 size_t count, loff_t *ppos) 371 { 372 int ret, val; 373 374 if (!mvm->ucode_loaded) 375 return -EIO; 376 377 if (!strncmp("disable_power_off_d0=", buf, 21)) { 378 if (sscanf(buf + 21, "%d", &val) != 1) 379 return -EINVAL; 380 mvm->disable_power_off = val; 381 } else if (!strncmp("disable_power_off_d3=", buf, 21)) { 382 if (sscanf(buf + 21, "%d", &val) != 1) 383 return -EINVAL; 384 mvm->disable_power_off_d3 = val; 385 } else { 386 return -EINVAL; 387 } 388 389 mutex_lock(&mvm->mutex); 390 ret = iwl_mvm_power_update_device(mvm); 391 mutex_unlock(&mvm->mutex); 392 393 return ret ?: count; 394 } 395 396 #define BT_MBOX_MSG(_notif, _num, _field) \ 397 ((le32_to_cpu((_notif)->mbox_msg[(_num)]) & BT_MBOX##_num##_##_field)\ 398 >> BT_MBOX##_num##_##_field##_POS) 399 400 401 #define BT_MBOX_PRINT(_num, _field, _end) \ 402 pos += scnprintf(buf + pos, bufsz - pos, \ 403 "\t%s: %d%s", \ 404 #_field, \ 405 BT_MBOX_MSG(notif, _num, _field), \ 406 true ? "\n" : ", "); 407 408 static 409 int iwl_mvm_coex_dump_mbox(struct iwl_bt_coex_profile_notif *notif, char *buf, 410 int pos, int bufsz) 411 { 412 pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw0:\n"); 413 414 BT_MBOX_PRINT(0, LE_SLAVE_LAT, false); 415 BT_MBOX_PRINT(0, LE_PROF1, false); 416 BT_MBOX_PRINT(0, LE_PROF2, false); 417 BT_MBOX_PRINT(0, LE_PROF_OTHER, false); 418 BT_MBOX_PRINT(0, CHL_SEQ_N, false); 419 BT_MBOX_PRINT(0, INBAND_S, false); 420 BT_MBOX_PRINT(0, LE_MIN_RSSI, false); 421 BT_MBOX_PRINT(0, LE_SCAN, false); 422 BT_MBOX_PRINT(0, LE_ADV, false); 423 BT_MBOX_PRINT(0, LE_MAX_TX_POWER, false); 424 BT_MBOX_PRINT(0, OPEN_CON_1, true); 425 426 pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw1:\n"); 427 428 BT_MBOX_PRINT(1, BR_MAX_TX_POWER, false); 429 BT_MBOX_PRINT(1, IP_SR, false); 430 BT_MBOX_PRINT(1, LE_MSTR, false); 431 BT_MBOX_PRINT(1, AGGR_TRFC_LD, false); 432 BT_MBOX_PRINT(1, MSG_TYPE, false); 433 BT_MBOX_PRINT(1, SSN, true); 434 435 pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw2:\n"); 436 437 BT_MBOX_PRINT(2, SNIFF_ACT, false); 438 BT_MBOX_PRINT(2, PAG, false); 439 BT_MBOX_PRINT(2, INQUIRY, false); 440 BT_MBOX_PRINT(2, CONN, false); 441 BT_MBOX_PRINT(2, SNIFF_INTERVAL, false); 442 BT_MBOX_PRINT(2, DISC, false); 443 BT_MBOX_PRINT(2, SCO_TX_ACT, false); 444 BT_MBOX_PRINT(2, SCO_RX_ACT, false); 445 BT_MBOX_PRINT(2, ESCO_RE_TX, false); 446 BT_MBOX_PRINT(2, SCO_DURATION, true); 447 448 pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw3:\n"); 449 450 BT_MBOX_PRINT(3, SCO_STATE, false); 451 BT_MBOX_PRINT(3, SNIFF_STATE, false); 452 BT_MBOX_PRINT(3, A2DP_STATE, false); 453 BT_MBOX_PRINT(3, ACL_STATE, false); 454 BT_MBOX_PRINT(3, MSTR_STATE, false); 455 BT_MBOX_PRINT(3, OBX_STATE, false); 456 BT_MBOX_PRINT(3, OPEN_CON_2, false); 457 BT_MBOX_PRINT(3, TRAFFIC_LOAD, false); 458 BT_MBOX_PRINT(3, CHL_SEQN_LSB, false); 459 BT_MBOX_PRINT(3, INBAND_P, false); 460 BT_MBOX_PRINT(3, MSG_TYPE_2, false); 461 BT_MBOX_PRINT(3, SSN_2, false); 462 BT_MBOX_PRINT(3, UPDATE_REQUEST, true); 463 464 return pos; 465 } 466 467 static ssize_t iwl_dbgfs_bt_notif_read(struct file *file, char __user *user_buf, 468 size_t count, loff_t *ppos) 469 { 470 struct iwl_mvm *mvm = file->private_data; 471 struct iwl_bt_coex_profile_notif *notif = &mvm->last_bt_notif; 472 char *buf; 473 int ret, pos = 0, bufsz = sizeof(char) * 1024; 474 475 buf = kmalloc(bufsz, GFP_KERNEL); 476 if (!buf) 477 return -ENOMEM; 478 479 mutex_lock(&mvm->mutex); 480 481 pos += iwl_mvm_coex_dump_mbox(notif, buf, pos, bufsz); 482 483 pos += scnprintf(buf + pos, bufsz - pos, "bt_ci_compliance = %d\n", 484 notif->bt_ci_compliance); 485 pos += scnprintf(buf + pos, bufsz - pos, "primary_ch_lut = %d\n", 486 le32_to_cpu(notif->primary_ch_lut)); 487 pos += scnprintf(buf + pos, bufsz - pos, "secondary_ch_lut = %d\n", 488 le32_to_cpu(notif->secondary_ch_lut)); 489 pos += scnprintf(buf + pos, 490 bufsz - pos, "bt_activity_grading = %d\n", 491 le32_to_cpu(notif->bt_activity_grading)); 492 pos += scnprintf(buf + pos, bufsz - pos, 493 "antenna isolation = %d CORUN LUT index = %d\n", 494 mvm->last_ant_isol, mvm->last_corun_lut); 495 pos += scnprintf(buf + pos, bufsz - pos, "bt_rrc = %d\n", 496 (notif->ttc_rrc_status >> 4) & 0xF); 497 pos += scnprintf(buf + pos, bufsz - pos, "bt_ttc = %d\n", 498 notif->ttc_rrc_status & 0xF); 499 500 pos += scnprintf(buf + pos, bufsz - pos, "sync_sco = %d\n", 501 IWL_MVM_BT_COEX_SYNC2SCO); 502 pos += scnprintf(buf + pos, bufsz - pos, "mplut = %d\n", 503 IWL_MVM_BT_COEX_MPLUT); 504 pos += scnprintf(buf + pos, bufsz - pos, "corunning = %d\n", 505 IWL_MVM_BT_COEX_CORUNNING); 506 507 mutex_unlock(&mvm->mutex); 508 509 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); 510 kfree(buf); 511 512 return ret; 513 } 514 #undef BT_MBOX_PRINT 515 516 static ssize_t iwl_dbgfs_bt_cmd_read(struct file *file, char __user *user_buf, 517 size_t count, loff_t *ppos) 518 { 519 struct iwl_mvm *mvm = file->private_data; 520 struct iwl_bt_coex_ci_cmd *cmd = &mvm->last_bt_ci_cmd; 521 char buf[256]; 522 int bufsz = sizeof(buf); 523 int pos = 0; 524 525 mutex_lock(&mvm->mutex); 526 527 pos += scnprintf(buf + pos, bufsz - pos, "Channel inhibition CMD\n"); 528 pos += scnprintf(buf + pos, bufsz - pos, 529 "\tPrimary Channel Bitmap 0x%016llx\n", 530 le64_to_cpu(cmd->bt_primary_ci)); 531 pos += scnprintf(buf + pos, bufsz - pos, 532 "\tSecondary Channel Bitmap 0x%016llx\n", 533 le64_to_cpu(cmd->bt_secondary_ci)); 534 535 mutex_unlock(&mvm->mutex); 536 537 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 538 } 539 540 static ssize_t 541 iwl_dbgfs_bt_tx_prio_write(struct iwl_mvm *mvm, char *buf, 542 size_t count, loff_t *ppos) 543 { 544 u32 bt_tx_prio; 545 546 if (sscanf(buf, "%u", &bt_tx_prio) != 1) 547 return -EINVAL; 548 if (bt_tx_prio > 4) 549 return -EINVAL; 550 551 mvm->bt_tx_prio = bt_tx_prio; 552 553 return count; 554 } 555 556 static ssize_t 557 iwl_dbgfs_bt_force_ant_write(struct iwl_mvm *mvm, char *buf, 558 size_t count, loff_t *ppos) 559 { 560 static const char * const modes_str[BT_FORCE_ANT_MAX] = { 561 [BT_FORCE_ANT_DIS] = "dis", 562 [BT_FORCE_ANT_AUTO] = "auto", 563 [BT_FORCE_ANT_BT] = "bt", 564 [BT_FORCE_ANT_WIFI] = "wifi", 565 }; 566 int ret, bt_force_ant_mode; 567 568 for (bt_force_ant_mode = 0; 569 bt_force_ant_mode < ARRAY_SIZE(modes_str); 570 bt_force_ant_mode++) { 571 if (!strcmp(buf, modes_str[bt_force_ant_mode])) 572 break; 573 } 574 575 if (bt_force_ant_mode >= ARRAY_SIZE(modes_str)) 576 return -EINVAL; 577 578 ret = 0; 579 mutex_lock(&mvm->mutex); 580 if (mvm->bt_force_ant_mode == bt_force_ant_mode) 581 goto out; 582 583 mvm->bt_force_ant_mode = bt_force_ant_mode; 584 IWL_DEBUG_COEX(mvm, "Force mode: %s\n", 585 modes_str[mvm->bt_force_ant_mode]); 586 ret = iwl_send_bt_init_conf(mvm); 587 588 out: 589 mutex_unlock(&mvm->mutex); 590 return ret ?: count; 591 } 592 593 #define PRINT_STATS_LE32(_struct, _memb) \ 594 pos += scnprintf(buf + pos, bufsz - pos, \ 595 fmt_table, #_memb, \ 596 le32_to_cpu(_struct->_memb)) 597 598 static ssize_t iwl_dbgfs_fw_rx_stats_read(struct file *file, 599 char __user *user_buf, size_t count, 600 loff_t *ppos) 601 { 602 struct iwl_mvm *mvm = file->private_data; 603 static const char *fmt_table = "\t%-30s %10u\n"; 604 static const char *fmt_header = "%-32s\n"; 605 int pos = 0; 606 char *buf; 607 int ret; 608 /* 43 is the size of each data line, 33 is the size of each header */ 609 size_t bufsz = 610 ((sizeof(struct mvm_statistics_rx) / sizeof(__le32)) * 43) + 611 (4 * 33) + 1; 612 613 struct mvm_statistics_rx_phy *ofdm; 614 struct mvm_statistics_rx_phy *cck; 615 struct mvm_statistics_rx_non_phy *general; 616 struct mvm_statistics_rx_ht_phy *ht; 617 618 buf = kzalloc(bufsz, GFP_KERNEL); 619 if (!buf) 620 return -ENOMEM; 621 622 mutex_lock(&mvm->mutex); 623 624 ofdm = &mvm->rx_stats.ofdm; 625 cck = &mvm->rx_stats.cck; 626 general = &mvm->rx_stats.general; 627 ht = &mvm->rx_stats.ofdm_ht; 628 629 pos += scnprintf(buf + pos, bufsz - pos, fmt_header, 630 "Statistics_Rx - OFDM"); 631 PRINT_STATS_LE32(ofdm, ina_cnt); 632 PRINT_STATS_LE32(ofdm, fina_cnt); 633 PRINT_STATS_LE32(ofdm, plcp_err); 634 PRINT_STATS_LE32(ofdm, crc32_err); 635 PRINT_STATS_LE32(ofdm, overrun_err); 636 PRINT_STATS_LE32(ofdm, early_overrun_err); 637 PRINT_STATS_LE32(ofdm, crc32_good); 638 PRINT_STATS_LE32(ofdm, false_alarm_cnt); 639 PRINT_STATS_LE32(ofdm, fina_sync_err_cnt); 640 PRINT_STATS_LE32(ofdm, sfd_timeout); 641 PRINT_STATS_LE32(ofdm, fina_timeout); 642 PRINT_STATS_LE32(ofdm, unresponded_rts); 643 PRINT_STATS_LE32(ofdm, rxe_frame_lmt_overrun); 644 PRINT_STATS_LE32(ofdm, sent_ack_cnt); 645 PRINT_STATS_LE32(ofdm, sent_cts_cnt); 646 PRINT_STATS_LE32(ofdm, sent_ba_rsp_cnt); 647 PRINT_STATS_LE32(ofdm, dsp_self_kill); 648 PRINT_STATS_LE32(ofdm, mh_format_err); 649 PRINT_STATS_LE32(ofdm, re_acq_main_rssi_sum); 650 PRINT_STATS_LE32(ofdm, reserved); 651 652 pos += scnprintf(buf + pos, bufsz - pos, fmt_header, 653 "Statistics_Rx - CCK"); 654 PRINT_STATS_LE32(cck, ina_cnt); 655 PRINT_STATS_LE32(cck, fina_cnt); 656 PRINT_STATS_LE32(cck, plcp_err); 657 PRINT_STATS_LE32(cck, crc32_err); 658 PRINT_STATS_LE32(cck, overrun_err); 659 PRINT_STATS_LE32(cck, early_overrun_err); 660 PRINT_STATS_LE32(cck, crc32_good); 661 PRINT_STATS_LE32(cck, false_alarm_cnt); 662 PRINT_STATS_LE32(cck, fina_sync_err_cnt); 663 PRINT_STATS_LE32(cck, sfd_timeout); 664 PRINT_STATS_LE32(cck, fina_timeout); 665 PRINT_STATS_LE32(cck, unresponded_rts); 666 PRINT_STATS_LE32(cck, rxe_frame_lmt_overrun); 667 PRINT_STATS_LE32(cck, sent_ack_cnt); 668 PRINT_STATS_LE32(cck, sent_cts_cnt); 669 PRINT_STATS_LE32(cck, sent_ba_rsp_cnt); 670 PRINT_STATS_LE32(cck, dsp_self_kill); 671 PRINT_STATS_LE32(cck, mh_format_err); 672 PRINT_STATS_LE32(cck, re_acq_main_rssi_sum); 673 PRINT_STATS_LE32(cck, reserved); 674 675 pos += scnprintf(buf + pos, bufsz - pos, fmt_header, 676 "Statistics_Rx - GENERAL"); 677 PRINT_STATS_LE32(general, bogus_cts); 678 PRINT_STATS_LE32(general, bogus_ack); 679 PRINT_STATS_LE32(general, non_bssid_frames); 680 PRINT_STATS_LE32(general, filtered_frames); 681 PRINT_STATS_LE32(general, non_channel_beacons); 682 PRINT_STATS_LE32(general, channel_beacons); 683 PRINT_STATS_LE32(general, num_missed_bcon); 684 PRINT_STATS_LE32(general, adc_rx_saturation_time); 685 PRINT_STATS_LE32(general, ina_detection_search_time); 686 PRINT_STATS_LE32(general, beacon_silence_rssi_a); 687 PRINT_STATS_LE32(general, beacon_silence_rssi_b); 688 PRINT_STATS_LE32(general, beacon_silence_rssi_c); 689 PRINT_STATS_LE32(general, interference_data_flag); 690 PRINT_STATS_LE32(general, channel_load); 691 PRINT_STATS_LE32(general, dsp_false_alarms); 692 PRINT_STATS_LE32(general, beacon_rssi_a); 693 PRINT_STATS_LE32(general, beacon_rssi_b); 694 PRINT_STATS_LE32(general, beacon_rssi_c); 695 PRINT_STATS_LE32(general, beacon_energy_a); 696 PRINT_STATS_LE32(general, beacon_energy_b); 697 PRINT_STATS_LE32(general, beacon_energy_c); 698 PRINT_STATS_LE32(general, num_bt_kills); 699 PRINT_STATS_LE32(general, mac_id); 700 PRINT_STATS_LE32(general, directed_data_mpdu); 701 702 pos += scnprintf(buf + pos, bufsz - pos, fmt_header, 703 "Statistics_Rx - HT"); 704 PRINT_STATS_LE32(ht, plcp_err); 705 PRINT_STATS_LE32(ht, overrun_err); 706 PRINT_STATS_LE32(ht, early_overrun_err); 707 PRINT_STATS_LE32(ht, crc32_good); 708 PRINT_STATS_LE32(ht, crc32_err); 709 PRINT_STATS_LE32(ht, mh_format_err); 710 PRINT_STATS_LE32(ht, agg_crc32_good); 711 PRINT_STATS_LE32(ht, agg_mpdu_cnt); 712 PRINT_STATS_LE32(ht, agg_cnt); 713 PRINT_STATS_LE32(ht, unsupport_mcs); 714 715 mutex_unlock(&mvm->mutex); 716 717 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); 718 kfree(buf); 719 720 return ret; 721 } 722 #undef PRINT_STAT_LE32 723 724 static ssize_t iwl_dbgfs_frame_stats_read(struct iwl_mvm *mvm, 725 char __user *user_buf, size_t count, 726 loff_t *ppos, 727 struct iwl_mvm_frame_stats *stats) 728 { 729 char *buff, *pos, *endpos; 730 int idx, i; 731 int ret; 732 static const size_t bufsz = 1024; 733 734 buff = kmalloc(bufsz, GFP_KERNEL); 735 if (!buff) 736 return -ENOMEM; 737 738 spin_lock_bh(&mvm->drv_stats_lock); 739 740 pos = buff; 741 endpos = pos + bufsz; 742 743 pos += scnprintf(pos, endpos - pos, 744 "Legacy/HT/VHT\t:\t%d/%d/%d\n", 745 stats->legacy_frames, 746 stats->ht_frames, 747 stats->vht_frames); 748 pos += scnprintf(pos, endpos - pos, "20/40/80\t:\t%d/%d/%d\n", 749 stats->bw_20_frames, 750 stats->bw_40_frames, 751 stats->bw_80_frames); 752 pos += scnprintf(pos, endpos - pos, "NGI/SGI\t\t:\t%d/%d\n", 753 stats->ngi_frames, 754 stats->sgi_frames); 755 pos += scnprintf(pos, endpos - pos, "SISO/MIMO2\t:\t%d/%d\n", 756 stats->siso_frames, 757 stats->mimo2_frames); 758 pos += scnprintf(pos, endpos - pos, "FAIL/SCSS\t:\t%d/%d\n", 759 stats->fail_frames, 760 stats->success_frames); 761 pos += scnprintf(pos, endpos - pos, "MPDUs agg\t:\t%d\n", 762 stats->agg_frames); 763 pos += scnprintf(pos, endpos - pos, "A-MPDUs\t\t:\t%d\n", 764 stats->ampdu_count); 765 pos += scnprintf(pos, endpos - pos, "Avg MPDUs/A-MPDU:\t%d\n", 766 stats->ampdu_count > 0 ? 767 (stats->agg_frames / stats->ampdu_count) : 0); 768 769 pos += scnprintf(pos, endpos - pos, "Last Rates\n"); 770 771 idx = stats->last_frame_idx - 1; 772 for (i = 0; i < ARRAY_SIZE(stats->last_rates); i++) { 773 idx = (idx + 1) % ARRAY_SIZE(stats->last_rates); 774 if (stats->last_rates[idx] == 0) 775 continue; 776 pos += scnprintf(pos, endpos - pos, "Rate[%d]: ", 777 (int)(ARRAY_SIZE(stats->last_rates) - i)); 778 pos += rs_pretty_print_rate(pos, stats->last_rates[idx]); 779 } 780 spin_unlock_bh(&mvm->drv_stats_lock); 781 782 ret = simple_read_from_buffer(user_buf, count, ppos, buff, pos - buff); 783 kfree(buff); 784 785 return ret; 786 } 787 788 static ssize_t iwl_dbgfs_drv_rx_stats_read(struct file *file, 789 char __user *user_buf, size_t count, 790 loff_t *ppos) 791 { 792 struct iwl_mvm *mvm = file->private_data; 793 794 return iwl_dbgfs_frame_stats_read(mvm, user_buf, count, ppos, 795 &mvm->drv_rx_stats); 796 } 797 798 static ssize_t iwl_dbgfs_fw_restart_write(struct iwl_mvm *mvm, char *buf, 799 size_t count, loff_t *ppos) 800 { 801 int ret; 802 803 mutex_lock(&mvm->mutex); 804 805 /* allow one more restart that we're provoking here */ 806 if (mvm->restart_fw >= 0) 807 mvm->restart_fw++; 808 809 /* take the return value to make compiler happy - it will fail anyway */ 810 ret = iwl_mvm_send_cmd_pdu(mvm, REPLY_ERROR, 0, 0, NULL); 811 812 mutex_unlock(&mvm->mutex); 813 814 return count; 815 } 816 817 static ssize_t iwl_dbgfs_fw_nmi_write(struct iwl_mvm *mvm, char *buf, 818 size_t count, loff_t *ppos) 819 { 820 int ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_NMI); 821 if (ret) 822 return ret; 823 824 iwl_force_nmi(mvm->trans); 825 826 iwl_mvm_unref(mvm, IWL_MVM_REF_NMI); 827 828 return count; 829 } 830 831 static ssize_t 832 iwl_dbgfs_scan_ant_rxchain_read(struct file *file, 833 char __user *user_buf, 834 size_t count, loff_t *ppos) 835 { 836 struct iwl_mvm *mvm = file->private_data; 837 int pos = 0; 838 char buf[32]; 839 const size_t bufsz = sizeof(buf); 840 841 /* print which antennas were set for the scan command by the user */ 842 pos += scnprintf(buf + pos, bufsz - pos, "Antennas for scan: "); 843 if (mvm->scan_rx_ant & ANT_A) 844 pos += scnprintf(buf + pos, bufsz - pos, "A"); 845 if (mvm->scan_rx_ant & ANT_B) 846 pos += scnprintf(buf + pos, bufsz - pos, "B"); 847 if (mvm->scan_rx_ant & ANT_C) 848 pos += scnprintf(buf + pos, bufsz - pos, "C"); 849 pos += scnprintf(buf + pos, bufsz - pos, " (%hhx)\n", mvm->scan_rx_ant); 850 851 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 852 } 853 854 static ssize_t 855 iwl_dbgfs_scan_ant_rxchain_write(struct iwl_mvm *mvm, char *buf, 856 size_t count, loff_t *ppos) 857 { 858 u8 scan_rx_ant; 859 860 if (sscanf(buf, "%hhx", &scan_rx_ant) != 1) 861 return -EINVAL; 862 if (scan_rx_ant > ANT_ABC) 863 return -EINVAL; 864 if (scan_rx_ant & ~(iwl_mvm_get_valid_rx_ant(mvm))) 865 return -EINVAL; 866 867 if (mvm->scan_rx_ant != scan_rx_ant) { 868 mvm->scan_rx_ant = scan_rx_ant; 869 if (fw_has_capa(&mvm->fw->ucode_capa, 870 IWL_UCODE_TLV_CAPA_UMAC_SCAN)) 871 iwl_mvm_config_scan(mvm); 872 } 873 874 return count; 875 } 876 877 static ssize_t iwl_dbgfs_indirection_tbl_write(struct iwl_mvm *mvm, 878 char *buf, size_t count, 879 loff_t *ppos) 880 { 881 struct iwl_rss_config_cmd cmd = { 882 .flags = cpu_to_le32(IWL_RSS_ENABLE), 883 .hash_mask = IWL_RSS_HASH_TYPE_IPV4_TCP | 884 IWL_RSS_HASH_TYPE_IPV4_UDP | 885 IWL_RSS_HASH_TYPE_IPV4_PAYLOAD | 886 IWL_RSS_HASH_TYPE_IPV6_TCP | 887 IWL_RSS_HASH_TYPE_IPV6_UDP | 888 IWL_RSS_HASH_TYPE_IPV6_PAYLOAD, 889 }; 890 int ret, i, num_repeats, nbytes = count / 2; 891 892 ret = hex2bin(cmd.indirection_table, buf, nbytes); 893 if (ret) 894 return ret; 895 896 /* 897 * The input is the redirection table, partial or full. 898 * Repeat the pattern if needed. 899 * For example, input of 01020F will be repeated 42 times, 900 * indirecting RSS hash results to queues 1, 2, 15 (skipping 901 * queues 3 - 14). 902 */ 903 num_repeats = ARRAY_SIZE(cmd.indirection_table) / nbytes; 904 for (i = 1; i < num_repeats; i++) 905 memcpy(&cmd.indirection_table[i * nbytes], 906 cmd.indirection_table, nbytes); 907 /* handle cut in the middle pattern for the last places */ 908 memcpy(&cmd.indirection_table[i * nbytes], cmd.indirection_table, 909 ARRAY_SIZE(cmd.indirection_table) % nbytes); 910 911 netdev_rss_key_fill(cmd.secret_key, sizeof(cmd.secret_key)); 912 913 mutex_lock(&mvm->mutex); 914 ret = iwl_mvm_send_cmd_pdu(mvm, RSS_CONFIG_CMD, 0, sizeof(cmd), &cmd); 915 mutex_unlock(&mvm->mutex); 916 917 return ret ?: count; 918 } 919 920 static ssize_t iwl_dbgfs_fw_dbg_conf_read(struct file *file, 921 char __user *user_buf, 922 size_t count, loff_t *ppos) 923 { 924 struct iwl_mvm *mvm = file->private_data; 925 int conf; 926 char buf[8]; 927 const size_t bufsz = sizeof(buf); 928 int pos = 0; 929 930 mutex_lock(&mvm->mutex); 931 conf = mvm->fw_dbg_conf; 932 mutex_unlock(&mvm->mutex); 933 934 pos += scnprintf(buf + pos, bufsz - pos, "%d\n", conf); 935 936 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 937 } 938 939 /* 940 * Enable / Disable continuous recording. 941 * Cause the FW to start continuous recording, by sending the relevant hcmd. 942 * Enable: input of every integer larger than 0, ENABLE_CONT_RECORDING. 943 * Disable: for 0 as input, DISABLE_CONT_RECORDING. 944 */ 945 static ssize_t iwl_dbgfs_cont_recording_write(struct iwl_mvm *mvm, 946 char *buf, size_t count, 947 loff_t *ppos) 948 { 949 struct iwl_trans *trans = mvm->trans; 950 const struct iwl_fw_dbg_dest_tlv *dest = trans->dbg_dest_tlv; 951 struct iwl_continuous_record_cmd cont_rec = {}; 952 int ret, rec_mode; 953 954 if (!dest) 955 return -EOPNOTSUPP; 956 957 if (dest->monitor_mode != SMEM_MODE || 958 trans->cfg->device_family != IWL_DEVICE_FAMILY_8000) 959 return -EOPNOTSUPP; 960 961 ret = kstrtoint(buf, 0, &rec_mode); 962 if (ret) 963 return ret; 964 965 cont_rec.record_mode.enable_recording = rec_mode ? 966 cpu_to_le16(ENABLE_CONT_RECORDING) : 967 cpu_to_le16(DISABLE_CONT_RECORDING); 968 969 mutex_lock(&mvm->mutex); 970 ret = iwl_mvm_send_cmd_pdu(mvm, LDBG_CONFIG_CMD, 0, 971 sizeof(cont_rec), &cont_rec); 972 mutex_unlock(&mvm->mutex); 973 974 return ret ?: count; 975 } 976 977 static ssize_t iwl_dbgfs_fw_dbg_conf_write(struct iwl_mvm *mvm, 978 char *buf, size_t count, 979 loff_t *ppos) 980 { 981 unsigned int conf_id; 982 int ret; 983 984 ret = kstrtouint(buf, 0, &conf_id); 985 if (ret) 986 return ret; 987 988 if (WARN_ON(conf_id >= FW_DBG_CONF_MAX)) 989 return -EINVAL; 990 991 mutex_lock(&mvm->mutex); 992 ret = iwl_mvm_start_fw_dbg_conf(mvm, conf_id); 993 mutex_unlock(&mvm->mutex); 994 995 return ret ?: count; 996 } 997 998 static ssize_t iwl_dbgfs_fw_dbg_collect_write(struct iwl_mvm *mvm, 999 char *buf, size_t count, 1000 loff_t *ppos) 1001 { 1002 int ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PRPH_WRITE); 1003 1004 if (ret) 1005 return ret; 1006 1007 iwl_mvm_fw_dbg_collect(mvm, FW_DBG_TRIGGER_USER, buf, 1008 (count - 1), NULL); 1009 1010 iwl_mvm_unref(mvm, IWL_MVM_REF_PRPH_WRITE); 1011 1012 return count; 1013 } 1014 1015 static ssize_t iwl_dbgfs_max_amsdu_len_write(struct iwl_mvm *mvm, 1016 char *buf, size_t count, 1017 loff_t *ppos) 1018 { 1019 unsigned int max_amsdu_len; 1020 int ret; 1021 1022 ret = kstrtouint(buf, 0, &max_amsdu_len); 1023 if (ret) 1024 return ret; 1025 1026 if (max_amsdu_len > IEEE80211_MAX_MPDU_LEN_VHT_11454) 1027 return -EINVAL; 1028 mvm->max_amsdu_len = max_amsdu_len; 1029 1030 return count; 1031 } 1032 1033 #define ADD_TEXT(...) pos += scnprintf(buf + pos, bufsz - pos, __VA_ARGS__) 1034 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING 1035 static ssize_t iwl_dbgfs_bcast_filters_read(struct file *file, 1036 char __user *user_buf, 1037 size_t count, loff_t *ppos) 1038 { 1039 struct iwl_mvm *mvm = file->private_data; 1040 struct iwl_bcast_filter_cmd cmd; 1041 const struct iwl_fw_bcast_filter *filter; 1042 char *buf; 1043 int bufsz = 1024; 1044 int i, j, pos = 0; 1045 ssize_t ret; 1046 1047 buf = kzalloc(bufsz, GFP_KERNEL); 1048 if (!buf) 1049 return -ENOMEM; 1050 1051 mutex_lock(&mvm->mutex); 1052 if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) { 1053 ADD_TEXT("None\n"); 1054 mutex_unlock(&mvm->mutex); 1055 goto out; 1056 } 1057 mutex_unlock(&mvm->mutex); 1058 1059 for (i = 0; cmd.filters[i].attrs[0].mask; i++) { 1060 filter = &cmd.filters[i]; 1061 1062 ADD_TEXT("Filter [%d]:\n", i); 1063 ADD_TEXT("\tDiscard=%d\n", filter->discard); 1064 ADD_TEXT("\tFrame Type: %s\n", 1065 filter->frame_type ? "IPv4" : "Generic"); 1066 1067 for (j = 0; j < ARRAY_SIZE(filter->attrs); j++) { 1068 const struct iwl_fw_bcast_filter_attr *attr; 1069 1070 attr = &filter->attrs[j]; 1071 if (!attr->mask) 1072 break; 1073 1074 ADD_TEXT("\tAttr [%d]: offset=%d (from %s), mask=0x%x, value=0x%x reserved=0x%x\n", 1075 j, attr->offset, 1076 attr->offset_type ? "IP End" : 1077 "Payload Start", 1078 be32_to_cpu(attr->mask), 1079 be32_to_cpu(attr->val), 1080 le16_to_cpu(attr->reserved1)); 1081 } 1082 } 1083 out: 1084 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1085 kfree(buf); 1086 return ret; 1087 } 1088 1089 static ssize_t iwl_dbgfs_bcast_filters_write(struct iwl_mvm *mvm, char *buf, 1090 size_t count, loff_t *ppos) 1091 { 1092 int pos, next_pos; 1093 struct iwl_fw_bcast_filter filter = {}; 1094 struct iwl_bcast_filter_cmd cmd; 1095 u32 filter_id, attr_id, mask, value; 1096 int err = 0; 1097 1098 if (sscanf(buf, "%d %hhi %hhi %n", &filter_id, &filter.discard, 1099 &filter.frame_type, &pos) != 3) 1100 return -EINVAL; 1101 1102 if (filter_id >= ARRAY_SIZE(mvm->dbgfs_bcast_filtering.cmd.filters) || 1103 filter.frame_type > BCAST_FILTER_FRAME_TYPE_IPV4) 1104 return -EINVAL; 1105 1106 for (attr_id = 0; attr_id < ARRAY_SIZE(filter.attrs); 1107 attr_id++) { 1108 struct iwl_fw_bcast_filter_attr *attr = 1109 &filter.attrs[attr_id]; 1110 1111 if (pos >= count) 1112 break; 1113 1114 if (sscanf(&buf[pos], "%hhi %hhi %i %i %n", 1115 &attr->offset, &attr->offset_type, 1116 &mask, &value, &next_pos) != 4) 1117 return -EINVAL; 1118 1119 attr->mask = cpu_to_be32(mask); 1120 attr->val = cpu_to_be32(value); 1121 if (mask) 1122 filter.num_attrs++; 1123 1124 pos += next_pos; 1125 } 1126 1127 mutex_lock(&mvm->mutex); 1128 memcpy(&mvm->dbgfs_bcast_filtering.cmd.filters[filter_id], 1129 &filter, sizeof(filter)); 1130 1131 /* send updated bcast filtering configuration */ 1132 if (mvm->dbgfs_bcast_filtering.override && 1133 iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) 1134 err = iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0, 1135 sizeof(cmd), &cmd); 1136 mutex_unlock(&mvm->mutex); 1137 1138 return err ?: count; 1139 } 1140 1141 static ssize_t iwl_dbgfs_bcast_filters_macs_read(struct file *file, 1142 char __user *user_buf, 1143 size_t count, loff_t *ppos) 1144 { 1145 struct iwl_mvm *mvm = file->private_data; 1146 struct iwl_bcast_filter_cmd cmd; 1147 char *buf; 1148 int bufsz = 1024; 1149 int i, pos = 0; 1150 ssize_t ret; 1151 1152 buf = kzalloc(bufsz, GFP_KERNEL); 1153 if (!buf) 1154 return -ENOMEM; 1155 1156 mutex_lock(&mvm->mutex); 1157 if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) { 1158 ADD_TEXT("None\n"); 1159 mutex_unlock(&mvm->mutex); 1160 goto out; 1161 } 1162 mutex_unlock(&mvm->mutex); 1163 1164 for (i = 0; i < ARRAY_SIZE(cmd.macs); i++) { 1165 const struct iwl_fw_bcast_mac *mac = &cmd.macs[i]; 1166 1167 ADD_TEXT("Mac [%d]: discard=%d attached_filters=0x%x\n", 1168 i, mac->default_discard, mac->attached_filters); 1169 } 1170 out: 1171 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1172 kfree(buf); 1173 return ret; 1174 } 1175 1176 static ssize_t iwl_dbgfs_bcast_filters_macs_write(struct iwl_mvm *mvm, 1177 char *buf, size_t count, 1178 loff_t *ppos) 1179 { 1180 struct iwl_bcast_filter_cmd cmd; 1181 struct iwl_fw_bcast_mac mac = {}; 1182 u32 mac_id, attached_filters; 1183 int err = 0; 1184 1185 if (!mvm->bcast_filters) 1186 return -ENOENT; 1187 1188 if (sscanf(buf, "%d %hhi %i", &mac_id, &mac.default_discard, 1189 &attached_filters) != 3) 1190 return -EINVAL; 1191 1192 if (mac_id >= ARRAY_SIZE(cmd.macs) || 1193 mac.default_discard > 1 || 1194 attached_filters >= BIT(ARRAY_SIZE(cmd.filters))) 1195 return -EINVAL; 1196 1197 mac.attached_filters = cpu_to_le16(attached_filters); 1198 1199 mutex_lock(&mvm->mutex); 1200 memcpy(&mvm->dbgfs_bcast_filtering.cmd.macs[mac_id], 1201 &mac, sizeof(mac)); 1202 1203 /* send updated bcast filtering configuration */ 1204 if (mvm->dbgfs_bcast_filtering.override && 1205 iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) 1206 err = iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0, 1207 sizeof(cmd), &cmd); 1208 mutex_unlock(&mvm->mutex); 1209 1210 return err ?: count; 1211 } 1212 #endif 1213 1214 #ifdef CONFIG_PM_SLEEP 1215 static ssize_t iwl_dbgfs_d3_sram_write(struct iwl_mvm *mvm, char *buf, 1216 size_t count, loff_t *ppos) 1217 { 1218 int store; 1219 1220 if (sscanf(buf, "%d", &store) != 1) 1221 return -EINVAL; 1222 1223 mvm->store_d3_resume_sram = store; 1224 1225 return count; 1226 } 1227 1228 static ssize_t iwl_dbgfs_d3_sram_read(struct file *file, char __user *user_buf, 1229 size_t count, loff_t *ppos) 1230 { 1231 struct iwl_mvm *mvm = file->private_data; 1232 const struct fw_img *img; 1233 int ofs, len, pos = 0; 1234 size_t bufsz, ret; 1235 char *buf; 1236 u8 *ptr = mvm->d3_resume_sram; 1237 1238 img = &mvm->fw->img[IWL_UCODE_WOWLAN]; 1239 len = img->sec[IWL_UCODE_SECTION_DATA].len; 1240 1241 bufsz = len * 4 + 256; 1242 buf = kzalloc(bufsz, GFP_KERNEL); 1243 if (!buf) 1244 return -ENOMEM; 1245 1246 pos += scnprintf(buf, bufsz, "D3 SRAM capture: %sabled\n", 1247 mvm->store_d3_resume_sram ? "en" : "dis"); 1248 1249 if (ptr) { 1250 for (ofs = 0; ofs < len; ofs += 16) { 1251 pos += scnprintf(buf + pos, bufsz - pos, 1252 "0x%.4x %16ph\n", ofs, ptr + ofs); 1253 } 1254 } else { 1255 pos += scnprintf(buf + pos, bufsz - pos, 1256 "(no data captured)\n"); 1257 } 1258 1259 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1260 1261 kfree(buf); 1262 1263 return ret; 1264 } 1265 #endif 1266 1267 #define PRINT_MVM_REF(ref) do { \ 1268 if (mvm->refs[ref]) \ 1269 pos += scnprintf(buf + pos, bufsz - pos, \ 1270 "\t(0x%lx): %d %s\n", \ 1271 BIT(ref), mvm->refs[ref], #ref); \ 1272 } while (0) 1273 1274 static ssize_t iwl_dbgfs_d0i3_refs_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 int i, pos = 0; 1280 char buf[256]; 1281 const size_t bufsz = sizeof(buf); 1282 u32 refs = 0; 1283 1284 for (i = 0; i < IWL_MVM_REF_COUNT; i++) 1285 if (mvm->refs[i]) 1286 refs |= BIT(i); 1287 1288 pos += scnprintf(buf + pos, bufsz - pos, "taken mvm refs: 0x%x\n", 1289 refs); 1290 1291 PRINT_MVM_REF(IWL_MVM_REF_UCODE_DOWN); 1292 PRINT_MVM_REF(IWL_MVM_REF_SCAN); 1293 PRINT_MVM_REF(IWL_MVM_REF_ROC); 1294 PRINT_MVM_REF(IWL_MVM_REF_ROC_AUX); 1295 PRINT_MVM_REF(IWL_MVM_REF_P2P_CLIENT); 1296 PRINT_MVM_REF(IWL_MVM_REF_AP_IBSS); 1297 PRINT_MVM_REF(IWL_MVM_REF_USER); 1298 PRINT_MVM_REF(IWL_MVM_REF_TX); 1299 PRINT_MVM_REF(IWL_MVM_REF_TX_AGG); 1300 PRINT_MVM_REF(IWL_MVM_REF_ADD_IF); 1301 PRINT_MVM_REF(IWL_MVM_REF_START_AP); 1302 PRINT_MVM_REF(IWL_MVM_REF_BSS_CHANGED); 1303 PRINT_MVM_REF(IWL_MVM_REF_PREPARE_TX); 1304 PRINT_MVM_REF(IWL_MVM_REF_PROTECT_TDLS); 1305 PRINT_MVM_REF(IWL_MVM_REF_CHECK_CTKILL); 1306 PRINT_MVM_REF(IWL_MVM_REF_PRPH_READ); 1307 PRINT_MVM_REF(IWL_MVM_REF_PRPH_WRITE); 1308 PRINT_MVM_REF(IWL_MVM_REF_NMI); 1309 PRINT_MVM_REF(IWL_MVM_REF_TM_CMD); 1310 PRINT_MVM_REF(IWL_MVM_REF_EXIT_WORK); 1311 PRINT_MVM_REF(IWL_MVM_REF_PROTECT_CSA); 1312 PRINT_MVM_REF(IWL_MVM_REF_FW_DBG_COLLECT); 1313 PRINT_MVM_REF(IWL_MVM_REF_INIT_UCODE); 1314 PRINT_MVM_REF(IWL_MVM_REF_SENDING_CMD); 1315 PRINT_MVM_REF(IWL_MVM_REF_RX); 1316 1317 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1318 } 1319 1320 static ssize_t iwl_dbgfs_d0i3_refs_write(struct iwl_mvm *mvm, char *buf, 1321 size_t count, loff_t *ppos) 1322 { 1323 unsigned long value; 1324 int ret; 1325 bool taken; 1326 1327 ret = kstrtoul(buf, 10, &value); 1328 if (ret < 0) 1329 return ret; 1330 1331 mutex_lock(&mvm->mutex); 1332 1333 taken = mvm->refs[IWL_MVM_REF_USER]; 1334 if (value == 1 && !taken) 1335 iwl_mvm_ref(mvm, IWL_MVM_REF_USER); 1336 else if (value == 0 && taken) 1337 iwl_mvm_unref(mvm, IWL_MVM_REF_USER); 1338 else 1339 ret = -EINVAL; 1340 1341 mutex_unlock(&mvm->mutex); 1342 1343 if (ret < 0) 1344 return ret; 1345 return count; 1346 } 1347 1348 #define MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz) \ 1349 _MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz, struct iwl_mvm) 1350 #define MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz) \ 1351 _MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz, struct iwl_mvm) 1352 #define MVM_DEBUGFS_ADD_FILE_ALIAS(alias, name, parent, mode) do { \ 1353 if (!debugfs_create_file(alias, mode, parent, mvm, \ 1354 &iwl_dbgfs_##name##_ops)) \ 1355 goto err; \ 1356 } while (0) 1357 #define MVM_DEBUGFS_ADD_FILE(name, parent, mode) \ 1358 MVM_DEBUGFS_ADD_FILE_ALIAS(#name, name, parent, mode) 1359 1360 static ssize_t 1361 iwl_dbgfs_prph_reg_read(struct file *file, 1362 char __user *user_buf, 1363 size_t count, loff_t *ppos) 1364 { 1365 struct iwl_mvm *mvm = file->private_data; 1366 int pos = 0; 1367 char buf[32]; 1368 const size_t bufsz = sizeof(buf); 1369 int ret; 1370 1371 if (!mvm->dbgfs_prph_reg_addr) 1372 return -EINVAL; 1373 1374 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PRPH_READ); 1375 if (ret) 1376 return ret; 1377 1378 pos += scnprintf(buf + pos, bufsz - pos, "Reg 0x%x: (0x%x)\n", 1379 mvm->dbgfs_prph_reg_addr, 1380 iwl_read_prph(mvm->trans, mvm->dbgfs_prph_reg_addr)); 1381 1382 iwl_mvm_unref(mvm, IWL_MVM_REF_PRPH_READ); 1383 1384 return simple_read_from_buffer(user_buf, count, ppos, buf, pos); 1385 } 1386 1387 static ssize_t 1388 iwl_dbgfs_prph_reg_write(struct iwl_mvm *mvm, char *buf, 1389 size_t count, loff_t *ppos) 1390 { 1391 u8 args; 1392 u32 value; 1393 int ret; 1394 1395 args = sscanf(buf, "%i %i", &mvm->dbgfs_prph_reg_addr, &value); 1396 /* if we only want to set the reg address - nothing more to do */ 1397 if (args == 1) 1398 goto out; 1399 1400 /* otherwise, make sure we have both address and value */ 1401 if (args != 2) 1402 return -EINVAL; 1403 1404 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PRPH_WRITE); 1405 if (ret) 1406 return ret; 1407 1408 iwl_write_prph(mvm->trans, mvm->dbgfs_prph_reg_addr, value); 1409 1410 iwl_mvm_unref(mvm, IWL_MVM_REF_PRPH_WRITE); 1411 out: 1412 return count; 1413 } 1414 1415 static ssize_t 1416 iwl_dbgfs_send_echo_cmd_write(struct iwl_mvm *mvm, char *buf, 1417 size_t count, loff_t *ppos) 1418 { 1419 int ret; 1420 1421 mutex_lock(&mvm->mutex); 1422 ret = iwl_mvm_send_cmd_pdu(mvm, ECHO_CMD, 0, 0, NULL); 1423 mutex_unlock(&mvm->mutex); 1424 1425 return ret ?: count; 1426 } 1427 1428 MVM_DEBUGFS_READ_WRITE_FILE_OPS(prph_reg, 64); 1429 1430 /* Device wide debugfs entries */ 1431 MVM_DEBUGFS_READ_FILE_OPS(ctdp_budget); 1432 MVM_DEBUGFS_WRITE_FILE_OPS(stop_ctdp, 8); 1433 MVM_DEBUGFS_WRITE_FILE_OPS(tx_flush, 16); 1434 MVM_DEBUGFS_WRITE_FILE_OPS(sta_drain, 8); 1435 MVM_DEBUGFS_WRITE_FILE_OPS(send_echo_cmd, 8); 1436 MVM_DEBUGFS_READ_WRITE_FILE_OPS(sram, 64); 1437 MVM_DEBUGFS_READ_WRITE_FILE_OPS(set_nic_temperature, 64); 1438 MVM_DEBUGFS_READ_FILE_OPS(nic_temp); 1439 MVM_DEBUGFS_READ_FILE_OPS(stations); 1440 MVM_DEBUGFS_READ_FILE_OPS(bt_notif); 1441 MVM_DEBUGFS_READ_FILE_OPS(bt_cmd); 1442 MVM_DEBUGFS_READ_WRITE_FILE_OPS(disable_power_off, 64); 1443 MVM_DEBUGFS_READ_FILE_OPS(fw_rx_stats); 1444 MVM_DEBUGFS_READ_FILE_OPS(drv_rx_stats); 1445 MVM_DEBUGFS_WRITE_FILE_OPS(fw_restart, 10); 1446 MVM_DEBUGFS_WRITE_FILE_OPS(fw_nmi, 10); 1447 MVM_DEBUGFS_WRITE_FILE_OPS(bt_tx_prio, 10); 1448 MVM_DEBUGFS_WRITE_FILE_OPS(bt_force_ant, 10); 1449 MVM_DEBUGFS_READ_WRITE_FILE_OPS(scan_ant_rxchain, 8); 1450 MVM_DEBUGFS_READ_WRITE_FILE_OPS(d0i3_refs, 8); 1451 MVM_DEBUGFS_READ_WRITE_FILE_OPS(fw_dbg_conf, 8); 1452 MVM_DEBUGFS_WRITE_FILE_OPS(fw_dbg_collect, 64); 1453 MVM_DEBUGFS_WRITE_FILE_OPS(cont_recording, 8); 1454 MVM_DEBUGFS_WRITE_FILE_OPS(max_amsdu_len, 8); 1455 MVM_DEBUGFS_WRITE_FILE_OPS(indirection_tbl, 1456 (IWL_RSS_INDIRECTION_TABLE_SIZE * 2)); 1457 1458 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING 1459 MVM_DEBUGFS_READ_WRITE_FILE_OPS(bcast_filters, 256); 1460 MVM_DEBUGFS_READ_WRITE_FILE_OPS(bcast_filters_macs, 256); 1461 #endif 1462 1463 #ifdef CONFIG_PM_SLEEP 1464 MVM_DEBUGFS_READ_WRITE_FILE_OPS(d3_sram, 8); 1465 #endif 1466 1467 int iwl_mvm_dbgfs_register(struct iwl_mvm *mvm, struct dentry *dbgfs_dir) 1468 { 1469 struct dentry *bcast_dir __maybe_unused; 1470 char buf[100]; 1471 1472 spin_lock_init(&mvm->drv_stats_lock); 1473 1474 mvm->debugfs_dir = dbgfs_dir; 1475 1476 MVM_DEBUGFS_ADD_FILE(tx_flush, mvm->debugfs_dir, S_IWUSR); 1477 MVM_DEBUGFS_ADD_FILE(sta_drain, mvm->debugfs_dir, S_IWUSR); 1478 MVM_DEBUGFS_ADD_FILE(sram, mvm->debugfs_dir, S_IWUSR | S_IRUSR); 1479 MVM_DEBUGFS_ADD_FILE(set_nic_temperature, mvm->debugfs_dir, 1480 S_IWUSR | S_IRUSR); 1481 MVM_DEBUGFS_ADD_FILE(nic_temp, dbgfs_dir, S_IRUSR); 1482 MVM_DEBUGFS_ADD_FILE(ctdp_budget, dbgfs_dir, S_IRUSR); 1483 MVM_DEBUGFS_ADD_FILE(stop_ctdp, dbgfs_dir, S_IWUSR); 1484 MVM_DEBUGFS_ADD_FILE(stations, dbgfs_dir, S_IRUSR); 1485 MVM_DEBUGFS_ADD_FILE(bt_notif, dbgfs_dir, S_IRUSR); 1486 MVM_DEBUGFS_ADD_FILE(bt_cmd, dbgfs_dir, S_IRUSR); 1487 MVM_DEBUGFS_ADD_FILE(disable_power_off, mvm->debugfs_dir, 1488 S_IRUSR | S_IWUSR); 1489 MVM_DEBUGFS_ADD_FILE(fw_rx_stats, mvm->debugfs_dir, S_IRUSR); 1490 MVM_DEBUGFS_ADD_FILE(drv_rx_stats, mvm->debugfs_dir, S_IRUSR); 1491 MVM_DEBUGFS_ADD_FILE(fw_restart, mvm->debugfs_dir, S_IWUSR); 1492 MVM_DEBUGFS_ADD_FILE(fw_nmi, mvm->debugfs_dir, S_IWUSR); 1493 MVM_DEBUGFS_ADD_FILE(bt_tx_prio, mvm->debugfs_dir, S_IWUSR); 1494 MVM_DEBUGFS_ADD_FILE(bt_force_ant, mvm->debugfs_dir, S_IWUSR); 1495 MVM_DEBUGFS_ADD_FILE(scan_ant_rxchain, mvm->debugfs_dir, 1496 S_IWUSR | S_IRUSR); 1497 MVM_DEBUGFS_ADD_FILE(prph_reg, mvm->debugfs_dir, S_IWUSR | S_IRUSR); 1498 MVM_DEBUGFS_ADD_FILE(d0i3_refs, mvm->debugfs_dir, S_IRUSR | S_IWUSR); 1499 MVM_DEBUGFS_ADD_FILE(fw_dbg_conf, mvm->debugfs_dir, S_IRUSR | S_IWUSR); 1500 MVM_DEBUGFS_ADD_FILE(fw_dbg_collect, mvm->debugfs_dir, S_IWUSR); 1501 MVM_DEBUGFS_ADD_FILE(max_amsdu_len, mvm->debugfs_dir, S_IWUSR); 1502 MVM_DEBUGFS_ADD_FILE(send_echo_cmd, mvm->debugfs_dir, S_IWUSR); 1503 MVM_DEBUGFS_ADD_FILE(cont_recording, mvm->debugfs_dir, S_IWUSR); 1504 MVM_DEBUGFS_ADD_FILE(indirection_tbl, mvm->debugfs_dir, S_IWUSR); 1505 if (!debugfs_create_bool("enable_scan_iteration_notif", 1506 S_IRUSR | S_IWUSR, 1507 mvm->debugfs_dir, 1508 &mvm->scan_iter_notif_enabled)) 1509 goto err; 1510 if (!debugfs_create_bool("drop_bcn_ap_mode", S_IRUSR | S_IWUSR, 1511 mvm->debugfs_dir, &mvm->drop_bcn_ap_mode)) 1512 goto err; 1513 1514 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING 1515 if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_BCAST_FILTERING) { 1516 bcast_dir = debugfs_create_dir("bcast_filtering", 1517 mvm->debugfs_dir); 1518 if (!bcast_dir) 1519 goto err; 1520 1521 if (!debugfs_create_bool("override", S_IRUSR | S_IWUSR, 1522 bcast_dir, 1523 &mvm->dbgfs_bcast_filtering.override)) 1524 goto err; 1525 1526 MVM_DEBUGFS_ADD_FILE_ALIAS("filters", bcast_filters, 1527 bcast_dir, S_IWUSR | S_IRUSR); 1528 MVM_DEBUGFS_ADD_FILE_ALIAS("macs", bcast_filters_macs, 1529 bcast_dir, S_IWUSR | S_IRUSR); 1530 } 1531 #endif 1532 1533 #ifdef CONFIG_PM_SLEEP 1534 MVM_DEBUGFS_ADD_FILE(d3_sram, mvm->debugfs_dir, S_IRUSR | S_IWUSR); 1535 MVM_DEBUGFS_ADD_FILE(d3_test, mvm->debugfs_dir, S_IRUSR); 1536 if (!debugfs_create_bool("d3_wake_sysassert", S_IRUSR | S_IWUSR, 1537 mvm->debugfs_dir, &mvm->d3_wake_sysassert)) 1538 goto err; 1539 if (!debugfs_create_u32("last_netdetect_scans", S_IRUSR, 1540 mvm->debugfs_dir, &mvm->last_netdetect_scans)) 1541 goto err; 1542 #endif 1543 1544 if (!debugfs_create_u8("ps_disabled", S_IRUSR, 1545 mvm->debugfs_dir, &mvm->ps_disabled)) 1546 goto err; 1547 if (!debugfs_create_blob("nvm_hw", S_IRUSR, 1548 mvm->debugfs_dir, &mvm->nvm_hw_blob)) 1549 goto err; 1550 if (!debugfs_create_blob("nvm_sw", S_IRUSR, 1551 mvm->debugfs_dir, &mvm->nvm_sw_blob)) 1552 goto err; 1553 if (!debugfs_create_blob("nvm_calib", S_IRUSR, 1554 mvm->debugfs_dir, &mvm->nvm_calib_blob)) 1555 goto err; 1556 if (!debugfs_create_blob("nvm_prod", S_IRUSR, 1557 mvm->debugfs_dir, &mvm->nvm_prod_blob)) 1558 goto err; 1559 if (!debugfs_create_blob("nvm_phy_sku", S_IRUSR, 1560 mvm->debugfs_dir, &mvm->nvm_phy_sku_blob)) 1561 goto err; 1562 1563 /* 1564 * Create a symlink with mac80211. It will be removed when mac80211 1565 * exists (before the opmode exists which removes the target.) 1566 */ 1567 snprintf(buf, 100, "../../%s/%s", 1568 dbgfs_dir->d_parent->d_parent->d_name.name, 1569 dbgfs_dir->d_parent->d_name.name); 1570 if (!debugfs_create_symlink("iwlwifi", mvm->hw->wiphy->debugfsdir, buf)) 1571 goto err; 1572 1573 return 0; 1574 err: 1575 IWL_ERR(mvm, "Can't create the mvm debugfs directory\n"); 1576 return -ENOMEM; 1577 } 1578