iwl-power.c revision 3e41ace5deef7af16dd277d9d17f9d36dca0a10e
15da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas/****************************************************************************** 25da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * 3901069c71415a76d731857ccda814e18ded062f7Wey-Yi Guy * Copyright(c) 2007 - 2011 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 7835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy#define ASLP (IWL_POWER_POWER_SAVE_ENA_MSK | \ 7935162ba75900209755628ccf7357763797037ba6Wey-Yi Guy IWL_POWER_POWER_MANAGEMENT_ENA_MSK | \ 8035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy IWL_POWER_ADVANCE_PM_ENA_MSK) 8135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy#define ASLP_TOUT(T) cpu_to_le32(T) 827af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define TU_TO_USEC 1024 837af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define SLP_TOUT(T) cpu_to_le32((T) * TU_TO_USEC) 847af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define SLP_VEC(X0, X1, X2, X3, X4) {cpu_to_le32(X0), \ 857af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg cpu_to_le32(X1), \ 867af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg cpu_to_le32(X2), \ 877af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg cpu_to_le32(X3), \ 887af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg cpu_to_le32(X4)} 895da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas/* default power management (not Tx power) table values */ 90e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg/* for DTIM period 0 through IWL_DTIM_RANGE_0_MAX */ 914ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy/* DTIM 0 - 2 */ 927af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Bergstatic const struct iwl_power_vec_entry range_0[IWL_POWER_NUM] = { 934ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy {{SLP, SLP_TOUT(200), SLP_TOUT(500), SLP_VEC(1, 1, 2, 2, 0xFF)}, 0}, 945da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(300), SLP_VEC(1, 2, 2, 2, 0xFF)}, 0}, 955da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(100), SLP_VEC(2, 2, 2, 2, 0xFF)}, 0}, 965da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(25), SLP_VEC(2, 2, 4, 4, 0xFF)}, 1}, 975da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(25), SLP_TOUT(25), SLP_VEC(2, 2, 4, 6, 0xFF)}, 2} 985da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas}; 995da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 1005da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 101e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg/* for DTIM period IWL_DTIM_RANGE_0_MAX + 1 through IWL_DTIM_RANGE_1_MAX */ 1024ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy/* DTIM 3 - 10 */ 1037af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Bergstatic const struct iwl_power_vec_entry range_1[IWL_POWER_NUM] = { 1045da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(500), SLP_VEC(1, 2, 3, 4, 4)}, 0}, 1055da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(300), SLP_VEC(1, 2, 3, 4, 7)}, 0}, 1065da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(100), SLP_VEC(2, 4, 6, 7, 9)}, 0}, 1075da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(25), SLP_VEC(2, 4, 6, 9, 10)}, 1}, 1084ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy {{SLP, SLP_TOUT(25), SLP_TOUT(25), SLP_VEC(2, 4, 6, 10, 10)}, 2} 1095da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas}; 1105da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 111e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg/* for DTIM period > IWL_DTIM_RANGE_1_MAX */ 1124ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy/* DTIM 11 - */ 1137af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Bergstatic const struct iwl_power_vec_entry range_2[IWL_POWER_NUM] = { 1145da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(500), SLP_VEC(1, 2, 3, 4, 0xFF)}, 0}, 1155da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(300), SLP_VEC(2, 4, 6, 7, 0xFF)}, 0}, 1165da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(100), SLP_VEC(2, 7, 9, 9, 0xFF)}, 0}, 1175da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(25), SLP_VEC(2, 7, 9, 9, 0xFF)}, 0}, 1185da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(25), SLP_TOUT(25), SLP_VEC(4, 7, 10, 10, 0xFF)}, 0} 1195da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas}; 1205da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 12135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy/* advance power management */ 12235162ba75900209755628ccf7357763797037ba6Wey-Yi Guy/* DTIM 0 - 2 */ 12335162ba75900209755628ccf7357763797037ba6Wey-Yi Guystatic const struct iwl_power_vec_entry apm_range_0[IWL_POWER_NUM] = { 12435162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 12535162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 12635162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 12735162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 12835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 12935162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 13035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 13135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 13235162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 13335162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 6, 8, 0xFF), ASLP_TOUT(2)}, 2} 13435162ba75900209755628ccf7357763797037ba6Wey-Yi Guy}; 13535162ba75900209755628ccf7357763797037ba6Wey-Yi Guy 13635162ba75900209755628ccf7357763797037ba6Wey-Yi Guy 13735162ba75900209755628ccf7357763797037ba6Wey-Yi Guy/* for DTIM period IWL_DTIM_RANGE_0_MAX + 1 through IWL_DTIM_RANGE_1_MAX */ 13835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy/* DTIM 3 - 10 */ 13935162ba75900209755628ccf7357763797037ba6Wey-Yi Guystatic const struct iwl_power_vec_entry apm_range_1[IWL_POWER_NUM] = { 14035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 14135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 14235162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 14335162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 14435162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 14535162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 14635162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 14735162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 14835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 14935162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 6, 8, 0xFF), 0}, 2} 15035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy}; 15135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy 15235162ba75900209755628ccf7357763797037ba6Wey-Yi Guy/* for DTIM period > IWL_DTIM_RANGE_1_MAX */ 15335162ba75900209755628ccf7357763797037ba6Wey-Yi Guy/* DTIM 11 - */ 15435162ba75900209755628ccf7357763797037ba6Wey-Yi Guystatic const struct iwl_power_vec_entry apm_range_2[IWL_POWER_NUM] = { 15535162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 15635162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 15735162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 15835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 15935162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 16035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 16135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 16235162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 16335162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 16435162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 6, 8, 0xFF), ASLP_TOUT(2)}, 2} 16535162ba75900209755628ccf7357763797037ba6Wey-Yi Guy}; 16635162ba75900209755628ccf7357763797037ba6Wey-Yi Guy 167e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstatic void iwl_static_sleep_cmd(struct iwl_priv *priv, 168e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg struct iwl_powertable_cmd *cmd, 169e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg enum iwl_power_level lvl, int period) 170e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg{ 171e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg const struct iwl_power_vec_entry *table; 1724ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy int max_sleep[IWL_POWER_VEC_SIZE] = { 0 }; 1734ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy int i; 1744ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy u8 skip; 1754ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy u32 slp_itrvl; 176e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 17735162ba75900209755628ccf7357763797037ba6Wey-Yi Guy if (priv->cfg->adv_pm) { 17835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy table = apm_range_2; 17935162ba75900209755628ccf7357763797037ba6Wey-Yi Guy if (period <= IWL_DTIM_RANGE_1_MAX) 18035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy table = apm_range_1; 18135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy if (period <= IWL_DTIM_RANGE_0_MAX) 18235162ba75900209755628ccf7357763797037ba6Wey-Yi Guy table = apm_range_0; 18335162ba75900209755628ccf7357763797037ba6Wey-Yi Guy } else { 18435162ba75900209755628ccf7357763797037ba6Wey-Yi Guy table = range_2; 18535162ba75900209755628ccf7357763797037ba6Wey-Yi Guy if (period <= IWL_DTIM_RANGE_1_MAX) 18635162ba75900209755628ccf7357763797037ba6Wey-Yi Guy table = range_1; 18735162ba75900209755628ccf7357763797037ba6Wey-Yi Guy if (period <= IWL_DTIM_RANGE_0_MAX) 18835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy table = range_0; 18935162ba75900209755628ccf7357763797037ba6Wey-Yi Guy } 190e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 1913e41ace5deef7af16dd277d9d17f9d36dca0a10eJohannes Berg if (WARN_ON(lvl < 0 || lvl >= IWL_POWER_NUM)) 1923e41ace5deef7af16dd277d9d17f9d36dca0a10eJohannes Berg memset(cmd, 0, sizeof(*cmd)); 1933e41ace5deef7af16dd277d9d17f9d36dca0a10eJohannes Berg else 1943e41ace5deef7af16dd277d9d17f9d36dca0a10eJohannes Berg *cmd = table[lvl].cmd; 195e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 196e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg if (period == 0) { 1974ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy skip = 0; 198e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg period = 1; 1994ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy for (i = 0; i < IWL_POWER_VEC_SIZE; i++) 2004ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy max_sleep[i] = 1; 2014ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy 202e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg } else { 2034ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy skip = table[lvl].no_dtim; 2044ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy for (i = 0; i < IWL_POWER_VEC_SIZE; i++) 2054ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy max_sleep[i] = le32_to_cpu(cmd->sleep_interval[i]); 2064ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy max_sleep[IWL_POWER_VEC_SIZE - 1] = skip + 1; 207e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg } 208e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 2094ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy slp_itrvl = le32_to_cpu(cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1]); 2104ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy /* figure out the listen interval based on dtim period and skip */ 2114ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (slp_itrvl == 0xFF) 2124ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1] = 2134ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cpu_to_le32(period * (skip + 1)); 2144ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy 2154ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy slp_itrvl = le32_to_cpu(cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1]); 2164ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (slp_itrvl > period) 2174ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1] = 2184ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cpu_to_le32((slp_itrvl / period) * period); 2194ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy 2204ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (skip) 221e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags |= IWL_POWER_SLEEP_OVER_DTIM_MSK; 2224ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy else 223e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags &= ~IWL_POWER_SLEEP_OVER_DTIM_MSK; 224e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 2251f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy if (priv->cfg->base_params->shadow_reg_enable) 2261f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy cmd->flags |= IWL_POWER_SHADOW_REG_ENA; 2271f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy else 2281f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy cmd->flags &= ~IWL_POWER_SHADOW_REG_ENA; 2291f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy 23088e58fc5d940c3463c7070a2a7a8a0ce65af3fdcStanislaw Gruszka if (iwl_advanced_bt_coexist(priv)) { 231e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy if (!priv->cfg->bt_params->bt_sco_disable) 232e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy cmd->flags |= IWL_POWER_BT_SCO_ENA; 233e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy else 234e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy cmd->flags &= ~IWL_POWER_BT_SCO_ENA; 235e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy } 236e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy 237e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy 2384ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy slp_itrvl = le32_to_cpu(cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1]); 239570af86e0ab7e7b42b2562ff3209c16ab1ebd5f8Wey-Yi Guy if (slp_itrvl > IWL_CONN_MAX_LISTEN_INTERVAL) 2404ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1] = 241570af86e0ab7e7b42b2562ff3209c16ab1ebd5f8Wey-Yi Guy cpu_to_le32(IWL_CONN_MAX_LISTEN_INTERVAL); 2424ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy 2434ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy /* enforce max sleep interval */ 2444ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy for (i = IWL_POWER_VEC_SIZE - 1; i >= 0 ; i--) { 2454ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (le32_to_cpu(cmd->sleep_interval[i]) > 2464ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy (max_sleep[i] * period)) 2474ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[i] = 2484ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cpu_to_le32(max_sleep[i] * period); 2494ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (i != (IWL_POWER_VEC_SIZE - 1)) { 2504ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (le32_to_cpu(cmd->sleep_interval[i]) > 2514ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy le32_to_cpu(cmd->sleep_interval[i+1])) 2524ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[i] = 2534ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[i+1]; 2544ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy } 2554ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy } 256e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 257e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg if (priv->power_data.pci_pm) 258e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags |= IWL_POWER_PCI_PM_MSK; 259e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg else 260e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags &= ~IWL_POWER_PCI_PM_MSK; 261e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 2624ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy IWL_DEBUG_POWER(priv, "numSkipDtim = %u, dtimPeriod = %d\n", 2634ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy skip, period); 264e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_DEBUG_POWER(priv, "Sleep command for index %d\n", lvl + 1); 265e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg} 266e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 267e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstatic void iwl_power_sleep_cam_cmd(struct iwl_priv *priv, 268e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg struct iwl_powertable_cmd *cmd) 2695da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas{ 270e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg memset(cmd, 0, sizeof(*cmd)); 2715da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 272e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg if (priv->power_data.pci_pm) 273e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags |= IWL_POWER_PCI_PM_MSK; 2745da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 275e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_DEBUG_POWER(priv, "Sleep command for CAM\n"); 2765da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas} 2775da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 278e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstatic void iwl_power_fill_sleep_cmd(struct iwl_priv *priv, 279e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg struct iwl_powertable_cmd *cmd, 280e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg int dynps_ms, int wakeup_period) 2815da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas{ 2824c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg /* 2834c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * These are the original power level 3 sleep successions. The 2844c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * device may behave better with such succession and was also 2854c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * only tested with that. Just like the original sleep commands, 2864c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * also adjust the succession here to the wakeup_period below. 2874c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * The ranges are the same as for the sleep commands, 0-2, 3-9 2884c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * and >10, which is selected based on the DTIM interval for 2894c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * the sleep index but here we use the wakeup period since that 2904c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg * is what we need to do for the latency requirements. 2914c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg */ 2924c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg static const u8 slp_succ_r0[IWL_POWER_VEC_SIZE] = { 2, 2, 2, 2, 2 }; 2934c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg static const u8 slp_succ_r1[IWL_POWER_VEC_SIZE] = { 2, 4, 6, 7, 9 }; 2944c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg static const u8 slp_succ_r2[IWL_POWER_VEC_SIZE] = { 2, 7, 9, 9, 0xFF }; 2954c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg const u8 *slp_succ = slp_succ_r0; 2965cd19c5f15f4bd3354cc7f8f8b1125018a84a25cWinkler, Tomas int i; 2975da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 2984c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg if (wakeup_period > IWL_DTIM_RANGE_0_MAX) 2994c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg slp_succ = slp_succ_r1; 3004c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg if (wakeup_period > IWL_DTIM_RANGE_1_MAX) 3014c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg slp_succ = slp_succ_r2; 3024c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg 303e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg memset(cmd, 0, sizeof(*cmd)); 3045cd19c5f15f4bd3354cc7f8f8b1125018a84a25cWinkler, Tomas 305e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags = IWL_POWER_DRIVER_ALLOW_SLEEP_MSK | 306e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_POWER_FAST_PD; /* no use seeing frames for others */ 3075da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 308e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg if (priv->power_data.pci_pm) 309e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags |= IWL_POWER_PCI_PM_MSK; 3105da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 3111f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy if (priv->cfg->base_params->shadow_reg_enable) 3121f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy cmd->flags |= IWL_POWER_SHADOW_REG_ENA; 3131f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy else 3141f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy cmd->flags &= ~IWL_POWER_SHADOW_REG_ENA; 3151f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy 31688e58fc5d940c3463c7070a2a7a8a0ce65af3fdcStanislaw Gruszka if (iwl_advanced_bt_coexist(priv)) { 317e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy if (!priv->cfg->bt_params->bt_sco_disable) 318e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy cmd->flags |= IWL_POWER_BT_SCO_ENA; 319e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy else 320e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy cmd->flags &= ~IWL_POWER_BT_SCO_ENA; 321e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy } 322e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy 323e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->rx_data_timeout = cpu_to_le32(1000 * dynps_ms); 324e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->tx_data_timeout = cpu_to_le32(1000 * dynps_ms); 3255da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 3265cd19c5f15f4bd3354cc7f8f8b1125018a84a25cWinkler, Tomas for (i = 0; i < IWL_POWER_VEC_SIZE; i++) 3274c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg cmd->sleep_interval[i] = 3284c561a02291326c50f9b1f647eae891af9d1f3b2Johannes Berg cpu_to_le32(min_t(int, slp_succ[i], wakeup_period)); 329e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 330e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_DEBUG_POWER(priv, "Automatic sleep command\n"); 331e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg} 3325da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 333e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstatic int iwl_set_power(struct iwl_priv *priv, struct iwl_powertable_cmd *cmd) 334e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg{ 335e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_DEBUG_POWER(priv, "Sending power/sleep command\n"); 336e1623446bb1de1834ff1c57b3e8ed341d5d4a927Tomas Winkler IWL_DEBUG_POWER(priv, "Flags value = 0x%08X\n", cmd->flags); 337e1623446bb1de1834ff1c57b3e8ed341d5d4a927Tomas Winkler IWL_DEBUG_POWER(priv, "Tx timeout = %u\n", le32_to_cpu(cmd->tx_data_timeout)); 338e1623446bb1de1834ff1c57b3e8ed341d5d4a927Tomas Winkler IWL_DEBUG_POWER(priv, "Rx timeout = %u\n", le32_to_cpu(cmd->rx_data_timeout)); 339e1623446bb1de1834ff1c57b3e8ed341d5d4a927Tomas Winkler IWL_DEBUG_POWER(priv, "Sleep interval vector = { %d , %d , %d , %d , %d }\n", 3405da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[0]), 3415da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[1]), 3425da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[2]), 3435da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[3]), 3445da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[4])); 3455da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 346e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg return iwl_send_cmd_pdu(priv, POWER_TABLE_CMD, 347e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg sizeof(struct iwl_powertable_cmd), cmd); 3485da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas} 3495da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 350ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszkastatic void iwl_power_build_cmd(struct iwl_priv *priv, 351ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka struct iwl_powertable_cmd *cmd) 3525da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas{ 3534d6959219bb71aa34383fc1a1a520820aee6292bJohannes Berg bool enabled = priv->hw->conf.flags & IEEE80211_CONF_PS; 354e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg int dtimper; 3555da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 3563a065ab3b57bedefa1d59c88f731da6513ac482aJohannes Berg dtimper = priv->hw->conf.ps_dtim_period ?: 1; 357e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 35823c0fcc66b4345ea97ae588c2e01f10c994652baWey-Yi Guy if (priv->hw->conf.flags & IEEE80211_CONF_IDLE) 359ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_static_sleep_cmd(priv, cmd, IWL_POWER_INDEX_5, 20); 3600975cc8fbf5b61b188734f2edd9e588c7edff2a1Wey-Yi Guy else if (priv->cfg->ops->lib->tt_ops.lower_power_detection && 3616ddbf8cd39dc1faee7ba60337b11eb02edfcbee6Wey-Yi Guy priv->cfg->ops->lib->tt_ops.tt_power_mode && 3626ddbf8cd39dc1faee7ba60337b11eb02edfcbee6Wey-Yi Guy priv->cfg->ops->lib->tt_ops.lower_power_detection(priv)) { 3636ddbf8cd39dc1faee7ba60337b11eb02edfcbee6Wey-Yi Guy /* in thermal throttling low power state */ 364ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_static_sleep_cmd(priv, cmd, 3656ddbf8cd39dc1faee7ba60337b11eb02edfcbee6Wey-Yi Guy priv->cfg->ops->lib->tt_ops.tt_power_mode(priv), dtimper); 3660975cc8fbf5b61b188734f2edd9e588c7edff2a1Wey-Yi Guy } else if (!enabled) 367ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_power_sleep_cam_cmd(priv, cmd); 368e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg else if (priv->power_data.debug_sleep_level_override >= 0) 369ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_static_sleep_cmd(priv, cmd, 370e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg priv->power_data.debug_sleep_level_override, 371e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg dtimper); 372e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg else if (no_sleep_autoadjust) 373ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_static_sleep_cmd(priv, cmd, IWL_POWER_INDEX_1, dtimper); 374e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg else 375ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_power_fill_sleep_cmd(priv, cmd, 376e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg priv->hw->conf.dynamic_ps_timeout, 377e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg priv->hw->conf.max_sleep_period); 378ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka} 379ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 380ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszkaint iwl_power_set_mode(struct iwl_priv *priv, struct iwl_powertable_cmd *cmd, 381ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka bool force) 382ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka{ 383ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka int ret; 384ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka bool update_chains; 385ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 386ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka lockdep_assert_held(&priv->mutex); 387ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 388ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka /* Don't update the RX chain when chain noise calibration is running */ 389ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka update_chains = priv->chain_noise_data.state == IWL_CHAIN_NOISE_DONE || 390ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka priv->chain_noise_data.state == IWL_CHAIN_NOISE_ALIVE; 391ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 392ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (!memcmp(&priv->power_data.sleep_cmd, cmd, sizeof(*cmd)) && !force) 393ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka return 0; 394ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 395ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (!iwl_is_ready_rf(priv)) 396ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka return -EIO; 397ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 398ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka /* scan complete use sleep_power_next, need to be updated */ 399ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka memcpy(&priv->power_data.sleep_cmd_next, cmd, sizeof(*cmd)); 400ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (test_bit(STATUS_SCANNING, &priv->status) && !force) { 401ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka IWL_DEBUG_INFO(priv, "Defer power set mode while scanning\n"); 402ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka return 0; 403ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka } 404ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 405ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (cmd->flags & IWL_POWER_DRIVER_ALLOW_SLEEP_MSK) 406ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka set_bit(STATUS_POWER_PMI, &priv->status); 4075da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 408ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka ret = iwl_set_power(priv, cmd); 409ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (!ret) { 410ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (!(cmd->flags & IWL_POWER_DRIVER_ALLOW_SLEEP_MSK)) 411ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka clear_bit(STATUS_POWER_PMI, &priv->status); 412ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 413ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (priv->cfg->ops->lib->update_chain_flags && update_chains) 414ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka priv->cfg->ops->lib->update_chain_flags(priv); 415ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka else if (priv->cfg->ops->lib->update_chain_flags) 416ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka IWL_DEBUG_POWER(priv, 4173a780d25428a0a391a8ba6c888cf4e89ac3fdbb1Wey-Yi Guy "Cannot update the power, chain noise " 418a71c8f62d46e4496011182658dc058303960c068Winkler, Tomas "calibration running: %d\n", 419a71c8f62d46e4496011182658dc058303960c068Winkler, Tomas priv->chain_noise_data.state); 420ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 421ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka memcpy(&priv->power_data.sleep_cmd, cmd, sizeof(*cmd)); 422ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka } else 423ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka IWL_ERR(priv, "set power fail, ret = %d", ret); 4245da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 4255da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas return ret; 4265da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas} 427ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 428ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszkaint iwl_power_update_mode(struct iwl_priv *priv, bool force) 429ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka{ 430ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka struct iwl_powertable_cmd cmd; 431ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 432ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_power_build_cmd(priv, &cmd); 433ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka return iwl_power_set_mode(priv, &cmd, force); 434ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka} 4355da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 436a96a27f97f2bbfc1fca54bc3c0b0d41484152740Tomas Winkler/* initialize to default */ 4375da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbasvoid iwl_power_initialize(struct iwl_priv *priv) 4385da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas{ 439e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg u16 lctl = iwl_pcie_link_ctl(priv); 440e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 441e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg priv->power_data.pci_pm = !(lctl & PCI_CFG_LINK_CTRL_VAL_L0S_EN); 442e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 443e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg priv->power_data.debug_sleep_level_override = -1; 444e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 445e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg memset(&priv->power_data.sleep_cmd, 0, 446e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg sizeof(priv->power_data.sleep_cmd)); 4475da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas} 448