iwl-power.c revision 1f37daf3233ccda5072f715d6c322d84833cdd92
15da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas/****************************************************************************** 25da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * 31f44780827c6bbbcd1f12d5c6b6ce84f49a96bc0Reinette Chatre * Copyright(c) 2007 - 2010 Intel Corporation. All rights reserved. 45da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * 55da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * Portions of this file are derived from the ipw3945 project, as well 65da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * as portions of the ieee80211 subsystem header files. 75da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * 85da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * This program is free software; you can redistribute it and/or modify it 95da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * under the terms of version 2 of the GNU General Public License as 105da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * published by the Free Software Foundation. 115da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * 125da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * This program is distributed in the hope that it will be useful, but WITHOUT 135da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 145da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 155da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * more details. 165da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * 175da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * You should have received a copy of the GNU General Public License along with 185da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * this program; if not, write to the Free Software Foundation, Inc., 195da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA 205da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * 215da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * The full GNU General Public License is included in this distribution in the 225da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * file called LICENSE. 235da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * 245da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * Contact Information: 25759ef89fb096c4a6ef078d3cfd5682ac037bd789Winkler, Tomas * Intel Linux Wireless <ilw@linux.intel.com> 265da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 275da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas *****************************************************************************/ 285da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 295da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 305da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas#include <linux/kernel.h> 315da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas#include <linux/module.h> 325a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 335da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas#include <linux/init.h> 345da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 355da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas#include <net/mac80211.h> 365da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 375da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas#include "iwl-eeprom.h" 383e0d4cb12f6fd97193a455b49125398b2231c87cTomas Winkler#include "iwl-dev.h" 395da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas#include "iwl-core.h" 4039b73fb15e4704fd4d1e33688135810637f5f3fbWey-Yi Guy#include "iwl-io.h" 415a36ba0e412a0e12a8bf2648a075226c1dd7870dTomas Winkler#include "iwl-commands.h" 425da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas#include "iwl-debug.h" 435da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas#include "iwl-power.h" 445da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 455da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas/* 46e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * Setting power level allows the card to go to sleep when not busy. 475da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * 48e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * We calculate a sleep command based on the required latency, which 49e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * we get from mac80211. In order to handle thermal throttling, we can 50e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * also use pre-defined power levels. 515da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas */ 525da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 53e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg/* 54e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * For now, keep using power level 1 instead of automatically 55e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * adjusting ... 56e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg */ 57e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergbool no_sleep_autoadjust = true; 58e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergmodule_param(no_sleep_autoadjust, bool, S_IRUGO); 59e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes BergMODULE_PARM_DESC(no_sleep_autoadjust, 60e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg "don't automatically adjust sleep level " 61e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg "according to maximum network latency"); 625da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 63e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg/* 64e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * This defines the old power levels. They are still used by default 65e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * (level 1) and for thermal throttle (levels 3 through 5) 66e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg */ 67e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 68e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstruct iwl_power_vec_entry { 69e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg struct iwl_powertable_cmd cmd; 704ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy u8 no_dtim; /* number of skip dtim */ 71e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg}; 72e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 73e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg#define IWL_DTIM_RANGE_0_MAX 2 74e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg#define IWL_DTIM_RANGE_1_MAX 10 755da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 767af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define NOSLP cpu_to_le16(0), 0, 0 777af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define SLP IWL_POWER_DRIVER_ALLOW_SLEEP_MSK, 0, 0 787af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define TU_TO_USEC 1024 797af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define SLP_TOUT(T) cpu_to_le32((T) * TU_TO_USEC) 807af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define SLP_VEC(X0, X1, X2, X3, X4) {cpu_to_le32(X0), \ 817af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg cpu_to_le32(X1), \ 827af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg cpu_to_le32(X2), \ 837af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg cpu_to_le32(X3), \ 847af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg cpu_to_le32(X4)} 855da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas/* default power management (not Tx power) table values */ 86e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg/* for DTIM period 0 through IWL_DTIM_RANGE_0_MAX */ 874ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy/* DTIM 0 - 2 */ 887af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Bergstatic const struct iwl_power_vec_entry range_0[IWL_POWER_NUM] = { 894ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy {{SLP, SLP_TOUT(200), SLP_TOUT(500), SLP_VEC(1, 1, 2, 2, 0xFF)}, 0}, 905da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(300), SLP_VEC(1, 2, 2, 2, 0xFF)}, 0}, 915da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(100), SLP_VEC(2, 2, 2, 2, 0xFF)}, 0}, 925da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(25), SLP_VEC(2, 2, 4, 4, 0xFF)}, 1}, 935da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(25), SLP_TOUT(25), SLP_VEC(2, 2, 4, 6, 0xFF)}, 2} 945da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas}; 955da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 965da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 97e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg/* for DTIM period IWL_DTIM_RANGE_0_MAX + 1 through IWL_DTIM_RANGE_1_MAX */ 984ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy/* DTIM 3 - 10 */ 997af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Bergstatic const struct iwl_power_vec_entry range_1[IWL_POWER_NUM] = { 1005da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(500), SLP_VEC(1, 2, 3, 4, 4)}, 0}, 1015da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(300), SLP_VEC(1, 2, 3, 4, 7)}, 0}, 1025da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(100), SLP_VEC(2, 4, 6, 7, 9)}, 0}, 1035da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(25), SLP_VEC(2, 4, 6, 9, 10)}, 1}, 1044ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy {{SLP, SLP_TOUT(25), SLP_TOUT(25), SLP_VEC(2, 4, 6, 10, 10)}, 2} 1055da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas}; 1065da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 107e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg/* for DTIM period > IWL_DTIM_RANGE_1_MAX */ 1084ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy/* DTIM 11 - */ 1097af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Bergstatic const struct iwl_power_vec_entry range_2[IWL_POWER_NUM] = { 1105da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(500), SLP_VEC(1, 2, 3, 4, 0xFF)}, 0}, 1115da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(300), SLP_VEC(2, 4, 6, 7, 0xFF)}, 0}, 1125da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(100), SLP_VEC(2, 7, 9, 9, 0xFF)}, 0}, 1135da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(25), SLP_VEC(2, 7, 9, 9, 0xFF)}, 0}, 1145da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(25), SLP_TOUT(25), SLP_VEC(4, 7, 10, 10, 0xFF)}, 0} 1155da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas}; 1165da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 117e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstatic void iwl_static_sleep_cmd(struct iwl_priv *priv, 118e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg struct iwl_powertable_cmd *cmd, 119e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg enum iwl_power_level lvl, int period) 120e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg{ 121e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg const struct iwl_power_vec_entry *table; 1224ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy int max_sleep[IWL_POWER_VEC_SIZE] = { 0 }; 1234ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy int i; 1244ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy u8 skip; 1254ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy u32 slp_itrvl; 126e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 127e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg table = range_2; 1284ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (period <= IWL_DTIM_RANGE_1_MAX) 129e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg table = range_1; 1304ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (period <= IWL_DTIM_RANGE_0_MAX) 131e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg table = range_0; 132e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 133e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg BUG_ON(lvl < 0 || lvl >= IWL_POWER_NUM); 134e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 135e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg *cmd = table[lvl].cmd; 136e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 137e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg if (period == 0) { 1384ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy skip = 0; 139e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg period = 1; 1404ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy for (i = 0; i < IWL_POWER_VEC_SIZE; i++) 1414ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy max_sleep[i] = 1; 1424ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy 143e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg } else { 1444ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy skip = table[lvl].no_dtim; 1454ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy for (i = 0; i < IWL_POWER_VEC_SIZE; i++) 1464ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy max_sleep[i] = le32_to_cpu(cmd->sleep_interval[i]); 1474ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy max_sleep[IWL_POWER_VEC_SIZE - 1] = skip + 1; 148e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg } 149e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 1504ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy slp_itrvl = le32_to_cpu(cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1]); 1514ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy /* figure out the listen interval based on dtim period and skip */ 1524ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (slp_itrvl == 0xFF) 1534ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1] = 1544ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cpu_to_le32(period * (skip + 1)); 1554ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy 1564ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy slp_itrvl = le32_to_cpu(cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1]); 1574ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (slp_itrvl > period) 1584ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1] = 1594ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cpu_to_le32((slp_itrvl / period) * period); 1604ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy 1614ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (skip) 162e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags |= IWL_POWER_SLEEP_OVER_DTIM_MSK; 1634ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy else 164e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags &= ~IWL_POWER_SLEEP_OVER_DTIM_MSK; 165e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 1661f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy if (priv->cfg->base_params->shadow_reg_enable) 1671f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy cmd->flags |= IWL_POWER_SHADOW_REG_ENA; 1681f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy else 1691f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy cmd->flags &= ~IWL_POWER_SHADOW_REG_ENA; 1701f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy 171e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy if (priv->cfg->bt_params && 172e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy priv->cfg->bt_params->advanced_bt_coexist) { 173e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy if (!priv->cfg->bt_params->bt_sco_disable) 174e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy cmd->flags |= IWL_POWER_BT_SCO_ENA; 175e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy else 176e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy cmd->flags &= ~IWL_POWER_BT_SCO_ENA; 177e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy } 178e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy 179e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy 1804ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy slp_itrvl = le32_to_cpu(cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1]); 181570af86e0ab7e7b42b2562ff3209c16ab1ebd5f8Wey-Yi Guy if (slp_itrvl > IWL_CONN_MAX_LISTEN_INTERVAL) 1824ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1] = 183570af86e0ab7e7b42b2562ff3209c16ab1ebd5f8Wey-Yi Guy cpu_to_le32(IWL_CONN_MAX_LISTEN_INTERVAL); 1844ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy 1854ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy /* enforce max sleep interval */ 1864ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy for (i = IWL_POWER_VEC_SIZE - 1; i >= 0 ; i--) { 1874ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (le32_to_cpu(cmd->sleep_interval[i]) > 1884ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy (max_sleep[i] * period)) 1894ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[i] = 1904ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cpu_to_le32(max_sleep[i] * period); 1914ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (i != (IWL_POWER_VEC_SIZE - 1)) { 1924ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (le32_to_cpu(cmd->sleep_interval[i]) > 1934ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy le32_to_cpu(cmd->sleep_interval[i+1])) 1944ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[i] = 1954ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[i+1]; 1964ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy } 1974ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy } 198e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 199e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg if (priv->power_data.pci_pm) 200e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags |= IWL_POWER_PCI_PM_MSK; 201e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg else 202e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags &= ~IWL_POWER_PCI_PM_MSK; 203e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 2044ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy IWL_DEBUG_POWER(priv, "numSkipDtim = %u, dtimPeriod = %d\n", 2054ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy skip, period); 206e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_DEBUG_POWER(priv, "Sleep command for index %d\n", lvl + 1); 207e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg} 208e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 209e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstatic void iwl_power_sleep_cam_cmd(struct iwl_priv *priv, 210e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg struct iwl_powertable_cmd *cmd) 2115da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas{ 212e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg memset(cmd, 0, sizeof(*cmd)); 2135da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 214e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg if (priv->power_data.pci_pm) 215e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags |= IWL_POWER_PCI_PM_MSK; 2165da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 217e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_DEBUG_POWER(priv, "Sleep command for CAM\n"); 2185da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas} 2195da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 220e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstatic void iwl_power_fill_sleep_cmd(struct iwl_priv *priv, 221e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg struct iwl_powertable_cmd *cmd, 222e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg int dynps_ms, int wakeup_period) 2235da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas{ 2244c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg /* 2254c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * These are the original power level 3 sleep successions. The 2264c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * device may behave better with such succession and was also 2274c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * only tested with that. Just like the original sleep commands, 2284c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * also adjust the succession here to the wakeup_period below. 2294c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * The ranges are the same as for the sleep commands, 0-2, 3-9 2304c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * and >10, which is selected based on the DTIM interval for 2314c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * the sleep index but here we use the wakeup period since that 2324c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * is what we need to do for the latency requirements. 2334c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg */ 2344c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg static const u8 slp_succ_r0[IWL_POWER_VEC_SIZE] = { 2, 2, 2, 2, 2 }; 2354c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg static const u8 slp_succ_r1[IWL_POWER_VEC_SIZE] = { 2, 4, 6, 7, 9 }; 2364c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg static const u8 slp_succ_r2[IWL_POWER_VEC_SIZE] = { 2, 7, 9, 9, 0xFF }; 2374c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg const u8 *slp_succ = slp_succ_r0; 2385cd19c5f15f4bd3354cc7f8f8b1125018a84a25cWinkler, Tomas int i; 2395da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 2404c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg if (wakeup_period > IWL_DTIM_RANGE_0_MAX) 2414c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg slp_succ = slp_succ_r1; 2424c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg if (wakeup_period > IWL_DTIM_RANGE_1_MAX) 2434c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg slp_succ = slp_succ_r2; 2444c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg 245e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg memset(cmd, 0, sizeof(*cmd)); 2465cd19c5f15f4bd3354cc7f8f8b1125018a84a25cWinkler, Tomas 247e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags = IWL_POWER_DRIVER_ALLOW_SLEEP_MSK | 248e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_POWER_FAST_PD; /* no use seeing frames for others */ 2495da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 250e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg if (priv->power_data.pci_pm) 251e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags |= IWL_POWER_PCI_PM_MSK; 2525da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 2531f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy if (priv->cfg->base_params->shadow_reg_enable) 2541f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy cmd->flags |= IWL_POWER_SHADOW_REG_ENA; 2551f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy else 2561f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy cmd->flags &= ~IWL_POWER_SHADOW_REG_ENA; 2571f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy 258e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy if (priv->cfg->bt_params && 259e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy priv->cfg->bt_params->advanced_bt_coexist) { 260e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy if (!priv->cfg->bt_params->bt_sco_disable) 261e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy cmd->flags |= IWL_POWER_BT_SCO_ENA; 262e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy else 263e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy cmd->flags &= ~IWL_POWER_BT_SCO_ENA; 264e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy } 265e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy 266e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->rx_data_timeout = cpu_to_le32(1000 * dynps_ms); 267e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->tx_data_timeout = cpu_to_le32(1000 * dynps_ms); 2685da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 2695cd19c5f15f4bd3354cc7f8f8b1125018a84a25cWinkler, Tomas for (i = 0; i < IWL_POWER_VEC_SIZE; i++) 2704c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg cmd->sleep_interval[i] = 2714c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg cpu_to_le32(min_t(int, slp_succ[i], wakeup_period)); 272e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 273e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_DEBUG_POWER(priv, "Automatic sleep command\n"); 274e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg} 2755da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 276e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstatic int iwl_set_power(struct iwl_priv *priv, struct iwl_powertable_cmd *cmd) 277e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg{ 278e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_DEBUG_POWER(priv, "Sending power/sleep command\n"); 279e1623446bb1de1834ff1c57b3e8ed341d5d4a927Tomas Winkler IWL_DEBUG_POWER(priv, "Flags value = 0x%08X\n", cmd->flags); 280e1623446bb1de1834ff1c57b3e8ed341d5d4a927Tomas Winkler IWL_DEBUG_POWER(priv, "Tx timeout = %u\n", le32_to_cpu(cmd->tx_data_timeout)); 281e1623446bb1de1834ff1c57b3e8ed341d5d4a927Tomas Winkler IWL_DEBUG_POWER(priv, "Rx timeout = %u\n", le32_to_cpu(cmd->rx_data_timeout)); 282e1623446bb1de1834ff1c57b3e8ed341d5d4a927Tomas Winkler IWL_DEBUG_POWER(priv, "Sleep interval vector = { %d , %d , %d , %d , %d }\n", 2835da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[0]), 2845da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[1]), 2855da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[2]), 2865da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[3]), 2875da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[4])); 2885da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 289e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg return iwl_send_cmd_pdu(priv, POWER_TABLE_CMD, 290e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg sizeof(struct iwl_powertable_cmd), cmd); 2915da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas} 2925da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 293ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszkastatic void iwl_power_build_cmd(struct iwl_priv *priv, 294ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka struct iwl_powertable_cmd *cmd) 2955da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas{ 2964d6959219bb71aa34383fc1a1a520820aee6292bJohannes Berg bool enabled = priv->hw->conf.flags & IEEE80211_CONF_PS; 297e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg int dtimper; 2985da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 2993a065ab3b57bedefa1d59c88f731da6513ac482aJohannes Berg dtimper = priv->hw->conf.ps_dtim_period ?: 1; 300e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 3017cb1b0887fcc61918e3d64827fbef968bb67a57aWey-Yi Guy if (priv->cfg->base_params->broken_powersave) 302ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_power_sleep_cam_cmd(priv, cmd); 3037cb1b0887fcc61918e3d64827fbef968bb67a57aWey-Yi Guy else if (priv->cfg->base_params->supports_idle && 30478f5fb7fc6c2c668a12fd6892c18baa20e4ffd27Johannes Berg priv->hw->conf.flags & IEEE80211_CONF_IDLE) 305ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_static_sleep_cmd(priv, cmd, IWL_POWER_INDEX_5, 20); 3060975cc8fbf5b61b188734f2edd9e588c7edff2a1Wey-Yi Guy else if (priv->cfg->ops->lib->tt_ops.lower_power_detection && 3076ddbf8cd39dc1faee7ba60337b11eb02edfcbee6Wey-Yi Guy priv->cfg->ops->lib->tt_ops.tt_power_mode && 3086ddbf8cd39dc1faee7ba60337b11eb02edfcbee6Wey-Yi Guy priv->cfg->ops->lib->tt_ops.lower_power_detection(priv)) { 3096ddbf8cd39dc1faee7ba60337b11eb02edfcbee6Wey-Yi Guy /* in thermal throttling low power state */ 310ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_static_sleep_cmd(priv, cmd, 3116ddbf8cd39dc1faee7ba60337b11eb02edfcbee6Wey-Yi Guy priv->cfg->ops->lib->tt_ops.tt_power_mode(priv), dtimper); 3120975cc8fbf5b61b188734f2edd9e588c7edff2a1Wey-Yi Guy } else if (!enabled) 313ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_power_sleep_cam_cmd(priv, cmd); 314e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg else if (priv->power_data.debug_sleep_level_override >= 0) 315ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_static_sleep_cmd(priv, cmd, 316e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg priv->power_data.debug_sleep_level_override, 317e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg dtimper); 318e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg else if (no_sleep_autoadjust) 319ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_static_sleep_cmd(priv, cmd, IWL_POWER_INDEX_1, dtimper); 320e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg else 321ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_power_fill_sleep_cmd(priv, cmd, 322e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg priv->hw->conf.dynamic_ps_timeout, 323e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg priv->hw->conf.max_sleep_period); 324ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka} 325ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 326ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszkaint iwl_power_set_mode(struct iwl_priv *priv, struct iwl_powertable_cmd *cmd, 327ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka bool force) 328ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka{ 329ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka int ret; 330ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka bool update_chains; 331ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 332ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka lockdep_assert_held(&priv->mutex); 333ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 334ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka /* Don't update the RX chain when chain noise calibration is running */ 335ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka update_chains = priv->chain_noise_data.state == IWL_CHAIN_NOISE_DONE || 336ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka priv->chain_noise_data.state == IWL_CHAIN_NOISE_ALIVE; 337ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 338ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (!memcmp(&priv->power_data.sleep_cmd, cmd, sizeof(*cmd)) && !force) 339ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka return 0; 340ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 341ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (!iwl_is_ready_rf(priv)) 342ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka return -EIO; 343ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 344ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka /* scan complete use sleep_power_next, need to be updated */ 345ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka memcpy(&priv->power_data.sleep_cmd_next, cmd, sizeof(*cmd)); 346ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (test_bit(STATUS_SCANNING, &priv->status) && !force) { 347ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka IWL_DEBUG_INFO(priv, "Defer power set mode while scanning\n"); 348ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka return 0; 349ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka } 350ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 351ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (cmd->flags & IWL_POWER_DRIVER_ALLOW_SLEEP_MSK) 352ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka set_bit(STATUS_POWER_PMI, &priv->status); 3535da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 354ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka ret = iwl_set_power(priv, cmd); 355ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (!ret) { 356ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (!(cmd->flags & IWL_POWER_DRIVER_ALLOW_SLEEP_MSK)) 357ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka clear_bit(STATUS_POWER_PMI, &priv->status); 358ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 359ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (priv->cfg->ops->lib->update_chain_flags && update_chains) 360ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka priv->cfg->ops->lib->update_chain_flags(priv); 361ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka else if (priv->cfg->ops->lib->update_chain_flags) 362ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka IWL_DEBUG_POWER(priv, 3633a780d25428a0a391a8ba6c888cf4e89ac3fdbb1Wey-Yi Guy "Cannot update the power, chain noise " 364a71c8f62d46e4496011182658dc058303960c068Winkler, Tomas "calibration running: %d\n", 365a71c8f62d46e4496011182658dc058303960c068Winkler, Tomas priv->chain_noise_data.state); 366ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 367ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka memcpy(&priv->power_data.sleep_cmd, cmd, sizeof(*cmd)); 368ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka } else 369ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka IWL_ERR(priv, "set power fail, ret = %d", ret); 3705da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 3715da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas return ret; 3725da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas} 373ac4f5457c7617999967e9740f8903b922714bab4Stanislaw GruszkaEXPORT_SYMBOL(iwl_power_set_mode); 374ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 375ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszkaint iwl_power_update_mode(struct iwl_priv *priv, bool force) 376ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka{ 377ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka struct iwl_powertable_cmd cmd; 378ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 379ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_power_build_cmd(priv, &cmd); 380ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka return iwl_power_set_mode(priv, &cmd, force); 381ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka} 3825da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed AbbasEXPORT_SYMBOL(iwl_power_update_mode); 3835da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 384a96a27f97f2bbfc1fca54bc3c0b0d41484152740Tomas Winkler/* initialize to default */ 3855da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbasvoid iwl_power_initialize(struct iwl_priv *priv) 3865da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas{ 387e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg u16 lctl = iwl_pcie_link_ctl(priv); 388e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 389e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg priv->power_data.pci_pm = !(lctl & PCI_CFG_LINK_CTRL_VAL_L0S_EN); 390e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 391e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg priv->power_data.debug_sleep_level_override = -1; 392e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 393e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg memset(&priv->power_data.sleep_cmd, 0, 394e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg sizeof(priv->power_data.sleep_cmd)); 3955da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas} 3965da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed AbbasEXPORT_SYMBOL(iwl_power_initialize); 397