utils.c revision 01a9ca510ba4413895d4add6f26665d6c37a5413
18ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg/****************************************************************************** 28ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 38ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * This file is provided under a dual BSD/GPLv2 license. When using or 48ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * redistributing this file, you may do so under either license. 58ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 68ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * GPL LICENSE SUMMARY 78ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 851368bf792c79eb917694a4155d62f04359e3734Emmanuel Grumbach * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. 98ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 108ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * This program is free software; you can redistribute it and/or modify 118ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * it under the terms of version 2 of the GNU General Public License as 128ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * published by the Free Software Foundation. 138ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 148ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * This program is distributed in the hope that it will be useful, but 158ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * WITHOUT ANY WARRANTY; without even the implied warranty of 168ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 178ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * General Public License for more details. 188ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 198ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * You should have received a copy of the GNU General Public License 208ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * along with this program; if not, write to the Free Software 218ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, 228ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * USA 238ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 248ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * The full GNU General Public License is included in this distribution 25410dc5aa5906ed49e2733b451a5287884e8a16dcEmmanuel Grumbach * in the file called COPYING. 268ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 278ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Contact Information: 288ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Intel Linux Wireless <ilw@linux.intel.com> 298ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 308ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 318ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * BSD LICENSE 328ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 3351368bf792c79eb917694a4155d62f04359e3734Emmanuel Grumbach * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. 348ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * All rights reserved. 358ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 368ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Redistribution and use in source and binary forms, with or without 378ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * modification, are permitted provided that the following conditions 388ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * are met: 398ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 408ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * * Redistributions of source code must retain the above copyright 418ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * notice, this list of conditions and the following disclaimer. 428ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * * Redistributions in binary form must reproduce the above copyright 438ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * notice, this list of conditions and the following disclaimer in 448ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * the documentation and/or other materials provided with the 458ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * distribution. 468ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * * Neither the name Intel Corporation nor the names of its 478ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * contributors may be used to endorse or promote products derived 488ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * from this software without specific prior written permission. 498ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 508ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 518ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 528ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 538ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 548ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 558ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 568ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 578ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 588ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 598ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 608ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 618ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 628ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg *****************************************************************************/ 638ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg#include <net/mac80211.h> 648ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 658ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg#include "iwl-debug.h" 668ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg#include "iwl-io.h" 678ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 688ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg#include "mvm.h" 698ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg#include "fw-api-rs.h" 708ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 718ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg/* 728ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Will return 0 even if the cmd failed when RFKILL is asserted unless 738ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * CMD_WANT_SKB is set in cmd->flags. 748ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg */ 758ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergint iwl_mvm_send_cmd(struct iwl_mvm *mvm, struct iwl_host_cmd *cmd) 768ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg{ 778ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg int ret; 788ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 79debff6184c32149bd08cfecfafbebb96201be37dJohannes Berg#if defined(CONFIG_IWLWIFI_DEBUGFS) && defined(CONFIG_PM_SLEEP) 80debff6184c32149bd08cfecfafbebb96201be37dJohannes Berg if (WARN_ON(mvm->d3_test_active)) 81debff6184c32149bd08cfecfafbebb96201be37dJohannes Berg return -EIO; 82debff6184c32149bd08cfecfafbebb96201be37dJohannes Berg#endif 83debff6184c32149bd08cfecfafbebb96201be37dJohannes Berg 848ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg /* 858ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Synchronous commands from this op-mode must hold 868ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * the mutex, this ensures we don't try to send two 878ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * (or more) synchronous commands at a time. 888ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg */ 898ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (!(cmd->flags & CMD_ASYNC)) 908ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg lockdep_assert_held(&mvm->mutex); 918ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 928ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg ret = iwl_trans_send_cmd(mvm->trans, cmd); 938ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 948ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg /* 958ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * If the caller wants the SKB, then don't hide any problems, the 968ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * caller might access the response buffer which will be NULL if 978ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * the command failed. 988ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg */ 998ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (cmd->flags & CMD_WANT_SKB) 1008ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return ret; 1018ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1028ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg /* Silently ignore failures if RFKILL is asserted */ 1038ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (!ret || ret == -ERFKILL) 1048ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return 0; 1058ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return ret; 1068ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} 1078ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1088ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergint iwl_mvm_send_cmd_pdu(struct iwl_mvm *mvm, u8 id, 1098ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 flags, u16 len, const void *data) 1108ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg{ 1118ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg struct iwl_host_cmd cmd = { 1128ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg .id = id, 1138ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg .len = { len, }, 1148ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg .data = { data, }, 1158ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg .flags = flags, 1168ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg }; 1178ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1188ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return iwl_mvm_send_cmd(mvm, &cmd); 1198ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} 1208ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1218ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg/* 1228ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * We assume that the caller set the status to the sucess value 1238ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg */ 1248ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergint iwl_mvm_send_cmd_status(struct iwl_mvm *mvm, struct iwl_host_cmd *cmd, 1258ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 *status) 1268ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg{ 1278ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg struct iwl_rx_packet *pkt; 1288ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg struct iwl_cmd_response *resp; 1298ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg int ret, resp_len; 1308ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1318ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg lockdep_assert_held(&mvm->mutex); 1328ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 133debff6184c32149bd08cfecfafbebb96201be37dJohannes Berg#if defined(CONFIG_IWLWIFI_DEBUGFS) && defined(CONFIG_PM_SLEEP) 134debff6184c32149bd08cfecfafbebb96201be37dJohannes Berg if (WARN_ON(mvm->d3_test_active)) 135debff6184c32149bd08cfecfafbebb96201be37dJohannes Berg return -EIO; 136debff6184c32149bd08cfecfafbebb96201be37dJohannes Berg#endif 137debff6184c32149bd08cfecfafbebb96201be37dJohannes Berg 1388ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg /* 1398ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Only synchronous commands can wait for status, 1408ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * we use WANT_SKB so the caller can't. 1418ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg */ 1428ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (WARN_ONCE(cmd->flags & (CMD_ASYNC | CMD_WANT_SKB), 1438ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg "cmd flags %x", cmd->flags)) 1448ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return -EINVAL; 1458ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1468ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg cmd->flags |= CMD_SYNC | CMD_WANT_SKB; 1478ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1488ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg ret = iwl_trans_send_cmd(mvm->trans, cmd); 1498ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (ret == -ERFKILL) { 1508ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg /* 1518ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * The command failed because of RFKILL, don't update 1528ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * the status, leave it as success and return 0. 1538ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg */ 1548ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return 0; 1558ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg } else if (ret) { 1568ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return ret; 1578ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg } 1588ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1598ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg pkt = cmd->resp_pkt; 1608ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg /* Can happen if RFKILL is asserted */ 1618ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (!pkt) { 1628ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg ret = 0; 1638ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg goto out_free_resp; 1648ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg } 1658ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1668ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (pkt->hdr.flags & IWL_CMD_FAILED_MSK) { 1678ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg ret = -EIO; 1688ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg goto out_free_resp; 1698ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg } 1708ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 17165b30348dbf9b529901b5c2b62dca6cad9017a2aJohannes Berg resp_len = iwl_rx_packet_payload_len(pkt); 17265b30348dbf9b529901b5c2b62dca6cad9017a2aJohannes Berg if (WARN_ON_ONCE(resp_len != sizeof(*resp))) { 1738ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg ret = -EIO; 1748ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg goto out_free_resp; 1758ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg } 1768ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1778ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg resp = (void *)pkt->data; 1788ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg *status = le32_to_cpu(resp->status); 1798ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg out_free_resp: 1808ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg iwl_free_resp(cmd); 1818ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return ret; 1828ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} 1838ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1848ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg/* 1858ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * We assume that the caller set the status to the sucess value 1868ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg */ 1878ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergint iwl_mvm_send_cmd_pdu_status(struct iwl_mvm *mvm, u8 id, u16 len, 1888ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg const void *data, u32 *status) 1898ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg{ 1908ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg struct iwl_host_cmd cmd = { 1918ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg .id = id, 1928ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg .len = { len, }, 1938ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg .data = { data, }, 1948ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg }; 1958ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1968ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return iwl_mvm_send_cmd_status(mvm, &cmd, status); 1978ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} 1988ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 1998ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg#define IWL_DECLARE_RATE_INFO(r) \ 2008ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg [IWL_RATE_##r##M_INDEX] = IWL_RATE_##r##M_PLCP 2018ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 2028ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg/* 2038ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Translate from fw_rate_index (IWL_RATE_XXM_INDEX) to PLCP 2048ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg */ 2058ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergstatic const u8 fw_rate_idx_to_plcp[IWL_RATE_COUNT] = { 2068ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_DECLARE_RATE_INFO(1), 2078ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_DECLARE_RATE_INFO(2), 2088ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_DECLARE_RATE_INFO(5), 2098ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_DECLARE_RATE_INFO(11), 2108ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_DECLARE_RATE_INFO(6), 2118ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_DECLARE_RATE_INFO(9), 2128ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_DECLARE_RATE_INFO(12), 2138ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_DECLARE_RATE_INFO(18), 2148ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_DECLARE_RATE_INFO(24), 2158ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_DECLARE_RATE_INFO(36), 2168ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_DECLARE_RATE_INFO(48), 2178ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_DECLARE_RATE_INFO(54), 2188ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg}; 2198ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 2208ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergint iwl_mvm_legacy_rate_to_mac80211_idx(u32 rate_n_flags, 2218ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg enum ieee80211_band band) 2228ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg{ 2238ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg int rate = rate_n_flags & RATE_LEGACY_RATE_MSK; 2248ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg int idx; 2258ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg int band_offset = 0; 2268ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 2278ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg /* Legacy rate format, search for match in table */ 2288ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (band == IEEE80211_BAND_5GHZ) 2298ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg band_offset = IWL_FIRST_OFDM_RATE; 2308ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg for (idx = band_offset; idx < IWL_RATE_COUNT_LEGACY; idx++) 2318ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (fw_rate_idx_to_plcp[idx] == rate) 2328ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return idx - band_offset; 2338ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 2348ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return -1; 2358ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} 2368ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 2378ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergu8 iwl_mvm_mac80211_idx_to_hwrate(int rate_idx) 2388ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg{ 2398ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg /* Get PLCP rate for tx_cmd->rate_n_flags */ 2408ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return fw_rate_idx_to_plcp[rate_idx]; 2418ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} 2428ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 2438ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergint iwl_mvm_rx_fw_error(struct iwl_mvm *mvm, struct iwl_rx_cmd_buffer *rxb, 2448ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg struct iwl_device_cmd *cmd) 2458ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg{ 2468ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg struct iwl_rx_packet *pkt = rxb_addr(rxb); 2478ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg struct iwl_error_resp *err_resp = (void *)pkt->data; 2488ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 2498ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "FW Error notification: type 0x%08X cmd_id 0x%02X\n", 2508ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg le32_to_cpu(err_resp->error_type), err_resp->cmd_id); 2518ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "FW Error notification: seq 0x%04X service 0x%08X\n", 2528ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg le16_to_cpu(err_resp->bad_cmd_seq_num), 2538ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg le32_to_cpu(err_resp->error_service)); 2548ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "FW Error notification: timestamp 0x%16llX\n", 2558ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg le64_to_cpu(err_resp->timestamp)); 2568ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return 0; 2578ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} 2588ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 2598ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg/* 2608ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Returns the first antenna as ANT_[ABC], as defined in iwl-config.h. 2618ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * The parameter should also be a combination of ANT_[ABC]. 2628ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg */ 2638ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergu8 first_antenna(u8 mask) 2648ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg{ 2658ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg BUILD_BUG_ON(ANT_A != BIT(0)); /* using ffs is wrong if not */ 266d7dad550e6ddb96db9d3e4d322f7d1dd8a6a9c8dEmmanuel Grumbach if (WARN_ON_ONCE(!mask)) /* ffs will return 0 if mask is zeroed */ 267d7dad550e6ddb96db9d3e4d322f7d1dd8a6a9c8dEmmanuel Grumbach return BIT(0); 268d7dad550e6ddb96db9d3e4d322f7d1dd8a6a9c8dEmmanuel Grumbach return BIT(ffs(mask) - 1); 2698ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} 2708ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 2718ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg/* 2728ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Toggles between TX antennas to send the probe request on. 2738ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Receives the bitmask of valid TX antennas and the *index* used 2748ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * for the last TX, and returns the next valid *index* to use. 2758ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * In order to set it in the tx_cmd, must do BIT(idx). 2768ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg */ 2778ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergu8 iwl_mvm_next_antenna(struct iwl_mvm *mvm, u8 valid, u8 last_idx) 2788ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg{ 2798ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u8 ind = last_idx; 2808ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg int i; 2818ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 2828ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg for (i = 0; i < RATE_MCS_ANT_NUM; i++) { 2838ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg ind = (ind + 1) % RATE_MCS_ANT_NUM; 2848ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (valid & BIT(ind)) 2858ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return ind; 2868ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg } 2878ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 2888ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg WARN_ONCE(1, "Failed to toggle between antennas 0x%x", valid); 2898ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return last_idx; 2908ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} 2918ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 2928ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergstatic struct { 2938ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg char *name; 2948ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u8 num; 2958ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} advanced_lookup[] = { 2968ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "NMI_INTERRUPT_WDG", 0x34 }, 2978ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "SYSASSERT", 0x35 }, 2988ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "UCODE_VERSION_MISMATCH", 0x37 }, 2998ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "BAD_COMMAND", 0x38 }, 3008ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "NMI_INTERRUPT_DATA_ACTION_PT", 0x3C }, 3018ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "FATAL_ERROR", 0x3D }, 3028ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "NMI_TRM_HW_ERR", 0x46 }, 3038ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "NMI_INTERRUPT_TRM", 0x4C }, 3048ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "NMI_INTERRUPT_BREAK_POINT", 0x54 }, 3058ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "NMI_INTERRUPT_WDG_RXF_FULL", 0x5C }, 3068ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "NMI_INTERRUPT_WDG_NO_RBD_RXF_FULL", 0x64 }, 3078ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "NMI_INTERRUPT_HOST", 0x66 }, 3088ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "NMI_INTERRUPT_ACTION_PT", 0x7C }, 3098ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "NMI_INTERRUPT_UNKNOWN", 0x84 }, 3108ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "NMI_INTERRUPT_INST_ACTION_PT", 0x86 }, 3118ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg { "ADVANCED_SYSASSERT", 0 }, 3128ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg}; 3138ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 3148ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergstatic const char *desc_lookup(u32 num) 3158ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg{ 3168ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg int i; 3178ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 3188ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg for (i = 0; i < ARRAY_SIZE(advanced_lookup) - 1; i++) 3198ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (advanced_lookup[i].num == num) 3208ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return advanced_lookup[i].name; 3218ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 3228ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg /* No entry matches 'num', so it is the last: ADVANCED_SYSASSERT */ 3238ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return advanced_lookup[i].name; 3248ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} 3258ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 3268ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg/* 3278ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * Note: This structure is read from the device with IO accesses, 3288ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * and the reading already does the endian conversion. As it is 3298ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * read with u32-sized accesses, any members with a different size 3308ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * need to be ordered correctly though! 3318ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg */ 3328ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergstruct iwl_error_event_table { 3338ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 valid; /* (nonzero) valid, (0) log is empty */ 3348ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 error_id; /* type of error */ 3358ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 pc; /* program counter */ 3368ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 blink1; /* branch link */ 3378ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 blink2; /* branch link */ 3388ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 ilink1; /* interrupt link */ 3398ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 ilink2; /* interrupt link */ 3408ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 data1; /* error-specific data */ 3418ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 data2; /* error-specific data */ 3428ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 data3; /* error-specific data */ 3438ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 bcon_time; /* beacon timer */ 3448ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 tsf_low; /* network timestamp function timer */ 3458ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 tsf_hi; /* network timestamp function timer */ 3468ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 gp1; /* GP1 timer register */ 3478ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 gp2; /* GP2 timer register */ 3488ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 gp3; /* GP3 timer register */ 3498ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 ucode_ver; /* uCode version */ 3508ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 hw_ver; /* HW Silicon version */ 3518ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 brd_ver; /* HW board version */ 3528ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 log_pc; /* log program counter */ 3538ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 frame_ptr; /* frame pointer */ 3548ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 stack_ptr; /* stack pointer */ 3558ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 hcmd; /* last host command header */ 3568ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 isr0; /* isr status register LMPM_NIC_ISR0: 3578ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * rxtx_flag */ 3588ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 isr1; /* isr status register LMPM_NIC_ISR1: 3598ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * host_flag */ 3608ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 isr2; /* isr status register LMPM_NIC_ISR2: 3618ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * enc_flag */ 3628ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 isr3; /* isr status register LMPM_NIC_ISR3: 3638ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * time_flag */ 3648ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 isr4; /* isr status register LMPM_NIC_ISR4: 3658ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * wico interrupt */ 3668ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 isr_pref; /* isr status register LMPM_NIC_PREF_STAT */ 3678ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 wait_event; /* wait event() caller address */ 3688ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 l2p_control; /* L2pControlField */ 3698ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 l2p_duration; /* L2pDurationField */ 3708ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 l2p_mhvalid; /* L2pMhValidBits */ 3718ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 l2p_addr_match; /* L2pAddrMatchStat */ 3728ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 lmpm_pmg_sel; /* indicate which clocks are turned on 3738ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * (LMPM_PMG_SEL) */ 3748ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 u_timestamp; /* indicate when the date and time of the 3758ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * compilation */ 3768ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 flow_handler; /* FH read/write pointers, RX credit */ 3778ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} __packed; 3788ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 37901a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary/* 38001a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary * UMAC error struct - relevant starting from family 8000 chip. 38101a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary * Note: This structure is read from the device with IO accesses, 38201a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary * and the reading already does the endian conversion. As it is 38301a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary * read with u32-sized accesses, any members with a different size 38401a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary * need to be ordered correctly though! 38501a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary */ 38601a9ca510ba4413895d4add6f26665d6c37a5413Eran Hararystruct iwl_umac_error_event_table { 38701a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary u32 valid; /* (nonzero) valid, (0) log is empty */ 38801a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary u32 error_id; /* type of error */ 38901a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary u32 pc; /* program counter */ 39001a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary u32 blink1; /* branch link */ 39101a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary u32 blink2; /* branch link */ 39201a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary u32 ilink1; /* interrupt link */ 39301a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary u32 ilink2; /* interrupt link */ 39401a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary u32 data1; /* error-specific data */ 39501a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary u32 data2; /* error-specific data */ 39601a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary u32 line; /* source code line of error */ 39701a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary u32 umac_ver; /* umac version */ 39801a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary} __packed; 39901a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary 4008ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg#define ERROR_START_OFFSET (1 * sizeof(u32)) 4018ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg#define ERROR_ELEM_SIZE (7 * sizeof(u32)) 4028ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 40301a9ca510ba4413895d4add6f26665d6c37a5413Eran Hararystatic void iwl_mvm_dump_umac_error_log(struct iwl_mvm *mvm) 40401a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary{ 40501a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary struct iwl_trans *trans = mvm->trans; 40601a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary struct iwl_umac_error_event_table table; 40701a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary u32 base; 40801a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary 40901a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary base = mvm->umac_error_event_table; 41001a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary 41101a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary if (base < 0x800000 || base >= 0x80C000) { 41201a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary IWL_ERR(mvm, 41301a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary "Not valid error log pointer 0x%08X for %s uCode\n", 41401a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary base, 41501a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary (mvm->cur_ucode == IWL_UCODE_INIT) 41601a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary ? "Init" : "RT"); 41701a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary return; 41801a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary } 41901a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary 42001a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary iwl_trans_read_mem_bytes(trans, base, &table, sizeof(table)); 42101a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary 42201a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary if (ERROR_START_OFFSET <= table.valid * ERROR_ELEM_SIZE) { 42301a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary IWL_ERR(trans, "Start IWL Error Log Dump:\n"); 42401a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary IWL_ERR(trans, "Status: 0x%08lX, count: %d\n", 42501a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary mvm->status, table.valid); 42601a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary } 42701a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary 42801a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary IWL_ERR(mvm, "0x%08X | %-28s\n", table.error_id, 42901a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary desc_lookup(table.error_id)); 43001a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary IWL_ERR(mvm, "0x%08X | umac uPc\n", table.pc); 43101a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary IWL_ERR(mvm, "0x%08X | umac branchlink1\n", table.blink1); 43201a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary IWL_ERR(mvm, "0x%08X | umac branchlink2\n", table.blink2); 43301a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary IWL_ERR(mvm, "0x%08X | umac interruptlink1\n", table.ilink1); 43401a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary IWL_ERR(mvm, "0x%08X | umac interruptlink2\n", table.ilink2); 43501a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary IWL_ERR(mvm, "0x%08X | umac data1\n", table.data1); 43601a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary IWL_ERR(mvm, "0x%08X | umac data2\n", table.data2); 43701a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary IWL_ERR(mvm, "0x%08X | umac version\n", table.umac_ver); 43801a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary} 43901a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary 4408ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Bergvoid iwl_mvm_dump_nic_error_log(struct iwl_mvm *mvm) 4418ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg{ 4428ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg struct iwl_trans *trans = mvm->trans; 4438ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg struct iwl_error_event_table table; 4448ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg u32 base; 4458ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 4468ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg base = mvm->error_event_table; 4478ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (mvm->cur_ucode == IWL_UCODE_INIT) { 4488ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (!base) 4498ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg base = mvm->fw->init_errlog_ptr; 4508ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg } else { 4518ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (!base) 4528ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg base = mvm->fw->inst_errlog_ptr; 4538ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg } 4548ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 45515ef4137928738fd9c7024597a6dbce1ed186d1eAriej Marjieh if (base < 0x800000) { 4568ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, 4578ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg "Not valid error log pointer 0x%08X for %s uCode\n", 4588ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg base, 4598ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg (mvm->cur_ucode == IWL_UCODE_INIT) 4608ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg ? "Init" : "RT"); 4618ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return; 4628ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg } 4638ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 4648ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg iwl_trans_read_mem_bytes(trans, base, &table, sizeof(table)); 4658ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 4668ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg if (ERROR_START_OFFSET <= table.valid * ERROR_ELEM_SIZE) { 4678ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(trans, "Start IWL Error Log Dump:\n"); 4688ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(trans, "Status: 0x%08lX, count: %d\n", 4698ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg mvm->status, table.valid); 4708ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg } 4718ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 4728ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg trace_iwlwifi_dev_ucode_error(trans->dev, table.error_id, table.tsf_low, 4738ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg table.data1, table.data2, table.data3, 4748ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg table.blink1, table.blink2, table.ilink1, 4758ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg table.ilink2, table.bcon_time, table.gp1, 4768ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg table.gp2, table.gp3, table.ucode_ver, 4778ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg table.hw_ver, table.brd_ver); 4788ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | %-28s\n", table.error_id, 4798ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg desc_lookup(table.error_id)); 4808ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | uPc\n", table.pc); 4818ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | branchlink1\n", table.blink1); 4828ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | branchlink2\n", table.blink2); 4838ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | interruptlink1\n", table.ilink1); 4848ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | interruptlink2\n", table.ilink2); 4858ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | data1\n", table.data1); 4868ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | data2\n", table.data2); 4878ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | data3\n", table.data3); 4888ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | beacon time\n", table.bcon_time); 4898ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | tsf low\n", table.tsf_low); 4908ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | tsf hi\n", table.tsf_hi); 4918ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | time gp1\n", table.gp1); 4928ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | time gp2\n", table.gp2); 4938ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | time gp3\n", table.gp3); 4948ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | uCode version\n", table.ucode_ver); 4958ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | hw version\n", table.hw_ver); 4968ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | board version\n", table.brd_ver); 4978ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | hcmd\n", table.hcmd); 4988ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | isr0\n", table.isr0); 4998ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | isr1\n", table.isr1); 5008ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | isr2\n", table.isr2); 5018ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | isr3\n", table.isr3); 5028ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | isr4\n", table.isr4); 5038ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | isr_pref\n", table.isr_pref); 5048ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | wait_event\n", table.wait_event); 5058ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | l2p_control\n", table.l2p_control); 5068ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | l2p_duration\n", table.l2p_duration); 5078ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | l2p_mhvalid\n", table.l2p_mhvalid); 5088ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | l2p_addr_match\n", table.l2p_addr_match); 5098ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | lmpm_pmg_sel\n", table.lmpm_pmg_sel); 5108ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | timestamp\n", table.u_timestamp); 5118ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg IWL_ERR(mvm, "0x%08X | flow_handler\n", table.flow_handler); 51201a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary 51301a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary if (mvm->support_umac_log) 51401a9ca510ba4413895d4add6f26665d6c37a5413Eran Harary iwl_mvm_dump_umac_error_log(mvm); 5158ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} 5168ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 5170c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottliebvoid iwl_mvm_dump_sram(struct iwl_mvm *mvm) 5180c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb{ 5190c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb const struct fw_img *img; 5200c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb int ofs, len = 0; 521fc1471f0613b8a31e6905d12e18aab0433375de8Emmanuel Grumbach int i; 522fc1471f0613b8a31e6905d12e18aab0433375de8Emmanuel Grumbach __le32 *buf; 5230c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb 5240c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb if (!mvm->ucode_loaded) 5250c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb return; 5260c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb 5270c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb img = &mvm->fw->img[mvm->cur_ucode]; 5280c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb ofs = img->sec[IWL_UCODE_SECTION_DATA].offset; 5290c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb len = img->sec[IWL_UCODE_SECTION_DATA].len; 5300c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb 5313394817f833f13958320ae6e0dccf347c1ce5200Emmanuel Grumbach buf = kzalloc(len, GFP_ATOMIC); 5320c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb if (!buf) 5330c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb return; 5340c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb 5350c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb iwl_trans_read_mem_bytes(mvm->trans, ofs, buf, len); 536fc1471f0613b8a31e6905d12e18aab0433375de8Emmanuel Grumbach len = len >> 2; 537fc1471f0613b8a31e6905d12e18aab0433375de8Emmanuel Grumbach for (i = 0; i < len; i++) { 538fc1471f0613b8a31e6905d12e18aab0433375de8Emmanuel Grumbach IWL_ERR(mvm, "0x%08X\n", le32_to_cpu(buf[i])); 539fc1471f0613b8a31e6905d12e18aab0433375de8Emmanuel Grumbach /* Add a small delay to let syslog catch up */ 540fc1471f0613b8a31e6905d12e18aab0433375de8Emmanuel Grumbach udelay(10); 541fc1471f0613b8a31e6905d12e18aab0433375de8Emmanuel Grumbach } 5420c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb 5430c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb kfree(buf); 5440c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb} 5450c393d4eac31912ad6ea362d4f9bf78aa1fe9a69Matti Gottlieb 5468ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg/** 5478ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * iwl_mvm_send_lq_cmd() - Send link quality command 5488ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * @init: This command is sent as part of station initialization right 5498ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * after station has been added. 5508ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * 5518ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * The link quality command is sent as the last step of station creation. 5528ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * This is the special case in which init is set and we call a callback in 5538ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * this case to clear the state indicating that station creation is in 5548ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg * progress. 5558ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg */ 5569e680946a48be7f7c074a60d8583b21815526d61Eyal Shapiraint iwl_mvm_send_lq_cmd(struct iwl_mvm *mvm, struct iwl_lq_cmd *lq, bool init) 5578ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg{ 5588ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg struct iwl_host_cmd cmd = { 5598ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg .id = LQ_CMD, 5608ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg .len = { sizeof(struct iwl_lq_cmd), }, 5619e680946a48be7f7c074a60d8583b21815526d61Eyal Shapira .flags = init ? CMD_SYNC : CMD_ASYNC, 5628ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg .data = { lq, }, 5638ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg }; 5648ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 565881acd8987f6633280247087219df465de784a69Emmanuel Grumbach if (WARN_ON(lq->sta_id == IWL_MVM_STATION_COUNT)) 5668ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return -EINVAL; 5678ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg 5688ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg return iwl_mvm_send_cmd(mvm, &cmd); 5698ca151b568b67a7b72dcfc6ee6ea7c107ddd795cJohannes Berg} 5709ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz 5719ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz/** 5729ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz * iwl_mvm_update_smps - Get a requst to change the SMPS mode 5739ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz * @req_type: The part of the driver who call for a change. 5749ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz * @smps_requests: The request to change the SMPS mode. 5759ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz * 5769ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz * Get a requst to change the SMPS mode, 5779ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz * and change it according to all other requests in the driver. 5789ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz */ 5799ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitzvoid iwl_mvm_update_smps(struct iwl_mvm *mvm, struct ieee80211_vif *vif, 5809ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz enum iwl_mvm_smps_type_request req_type, 5819ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz enum ieee80211_smps_mode smps_request) 5829ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz{ 5839ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz struct iwl_mvm_vif *mvmvif; 584f6415f6bcf8f977b3708672e979f22450c1f5d66Emmanuel Grumbach enum ieee80211_smps_mode smps_mode; 5859ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz int i; 5869ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz 5879ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz lockdep_assert_held(&mvm->mutex); 588710e4d08f2ab6eed7950884ab30e684704e325caEmmanuel Grumbach 589710e4d08f2ab6eed7950884ab30e684704e325caEmmanuel Grumbach /* SMPS is irrelevant for NICs that don't have at least 2 RX antenna */ 590710e4d08f2ab6eed7950884ab30e684704e325caEmmanuel Grumbach if (num_of_ant(iwl_fw_valid_rx_ant(mvm->fw)) == 1) 591710e4d08f2ab6eed7950884ab30e684704e325caEmmanuel Grumbach return; 592710e4d08f2ab6eed7950884ab30e684704e325caEmmanuel Grumbach 593f6415f6bcf8f977b3708672e979f22450c1f5d66Emmanuel Grumbach if (vif->type == NL80211_IFTYPE_AP) 594f6415f6bcf8f977b3708672e979f22450c1f5d66Emmanuel Grumbach smps_mode = IEEE80211_SMPS_OFF; 595f6415f6bcf8f977b3708672e979f22450c1f5d66Emmanuel Grumbach else 596f6415f6bcf8f977b3708672e979f22450c1f5d66Emmanuel Grumbach smps_mode = IEEE80211_SMPS_AUTOMATIC; 597f6415f6bcf8f977b3708672e979f22450c1f5d66Emmanuel Grumbach 5989ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz mvmvif = iwl_mvm_vif_from_mac80211(vif); 5999ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz mvmvif->smps_requests[req_type] = smps_request; 6009ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz for (i = 0; i < NUM_IWL_MVM_SMPS_REQ; i++) { 6019ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz if (mvmvif->smps_requests[i] == IEEE80211_SMPS_STATIC) { 6029ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz smps_mode = IEEE80211_SMPS_STATIC; 6039ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz break; 6049ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz } 6059ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz if (mvmvif->smps_requests[i] == IEEE80211_SMPS_DYNAMIC) 6069ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz smps_mode = IEEE80211_SMPS_DYNAMIC; 6079ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz } 6089ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz 6099ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz ieee80211_request_smps(vif, smps_mode); 6109ee718aa9269cf56040cf12f0f6ac6e0057397b2Eytan Lifshitz} 611a21d7bcbf4c65bb7f79e16287d41040e4c7f5596Johannes Berg 612a21d7bcbf4c65bb7f79e16287d41040e4c7f5596Johannes Bergint iwl_mvm_update_low_latency(struct iwl_mvm *mvm, struct ieee80211_vif *vif, 613a21d7bcbf4c65bb7f79e16287d41040e4c7f5596Johannes Berg bool value) 614a21d7bcbf4c65bb7f79e16287d41040e4c7f5596Johannes Berg{ 615a21d7bcbf4c65bb7f79e16287d41040e4c7f5596Johannes Berg struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); 616e03f9bef2f9de4295df91a235c6b521dd64ef655Johannes Berg int res; 617a21d7bcbf4c65bb7f79e16287d41040e4c7f5596Johannes Berg 618a21d7bcbf4c65bb7f79e16287d41040e4c7f5596Johannes Berg lockdep_assert_held(&mvm->mutex); 619a21d7bcbf4c65bb7f79e16287d41040e4c7f5596Johannes Berg 620a21d7bcbf4c65bb7f79e16287d41040e4c7f5596Johannes Berg mvmvif->low_latency = value; 621a21d7bcbf4c65bb7f79e16287d41040e4c7f5596Johannes Berg 622e03f9bef2f9de4295df91a235c6b521dd64ef655Johannes Berg res = iwl_mvm_update_quotas(mvm, NULL); 623e03f9bef2f9de4295df91a235c6b521dd64ef655Johannes Berg if (res) 624e03f9bef2f9de4295df91a235c6b521dd64ef655Johannes Berg return res; 6250ee5bcdd77e7a7b54e0d79c2582dc22296c462cbEmmanuel Grumbach 6260ee5bcdd77e7a7b54e0d79c2582dc22296c462cbEmmanuel Grumbach iwl_mvm_bt_coex_vif_change(mvm); 6270ee5bcdd77e7a7b54e0d79c2582dc22296c462cbEmmanuel Grumbach 628e5e7aa8e2561019fb3f417041d50e1c0df8f5e42Emmanuel Grumbach return iwl_mvm_power_update_mac(mvm, vif); 629a21d7bcbf4c65bb7f79e16287d41040e4c7f5596Johannes Berg} 630