15da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas/****************************************************************************** 25da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * 351368bf792c79eb917694a4155d62f04359e3734Emmanuel Grumbach * Copyright(c) 2007 - 2014 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 <net/mac80211.h> 3439b73fb15e4704fd4d1e33688135810637f5f3fbWey-Yi Guy#include "iwl-io.h" 355da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas#include "iwl-debug.h" 36bdfbf0924ab05e02d28e50bd2d5024097642a78dEmmanuel Grumbach#include "iwl-trans.h" 3765de7e84fdc71a409f1d97aba8e44ece26628f51Johannes Berg#include "iwl-modparams.h" 381023fdc4858b6b8cb88ff28cafd425b77555be9fJohannes Berg#include "dev.h" 391023fdc4858b6b8cb88ff28cafd425b77555be9fJohannes Berg#include "agn.h" 401023fdc4858b6b8cb88ff28cafd425b77555be9fJohannes Berg#include "commands.h" 411023fdc4858b6b8cb88ff28cafd425b77555be9fJohannes Berg#include "power.h" 425da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 43f8dfc607b2b460e8e8adfdfb3c5f5bba3a4ad01bEmmanuel Grumbachstatic bool force_cam = true; 44c9e38e770981ff25d203f0f5c1423a863c484446Andy Lutomirskimodule_param(force_cam, bool, 0644); 45c9e38e770981ff25d203f0f5c1423a863c484446Andy LutomirskiMODULE_PARM_DESC(force_cam, "force continuously aware mode (no power saving at all)"); 46c9e38e770981ff25d203f0f5c1423a863c484446Andy Lutomirski 475da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas/* 48e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * Setting power level allows the card to go to sleep when not busy. 495da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas * 50e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * We calculate a sleep command based on the required latency, which 51e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * we get from mac80211. In order to handle thermal throttling, we can 52e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * also use pre-defined power levels. 535da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas */ 545da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 55e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg/* 56e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * This defines the old power levels. They are still used by default 57e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg * (level 1) and for thermal throttle (levels 3 through 5) 58e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg */ 59e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 60e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstruct iwl_power_vec_entry { 61e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg struct iwl_powertable_cmd cmd; 624ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy u8 no_dtim; /* number of skip dtim */ 63e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg}; 64e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 65e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg#define IWL_DTIM_RANGE_0_MAX 2 66e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg#define IWL_DTIM_RANGE_1_MAX 10 675da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 687af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define NOSLP cpu_to_le16(0), 0, 0 697af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define SLP IWL_POWER_DRIVER_ALLOW_SLEEP_MSK, 0, 0 7035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy#define ASLP (IWL_POWER_POWER_SAVE_ENA_MSK | \ 7135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy IWL_POWER_POWER_MANAGEMENT_ENA_MSK | \ 7235162ba75900209755628ccf7357763797037ba6Wey-Yi Guy IWL_POWER_ADVANCE_PM_ENA_MSK) 7335162ba75900209755628ccf7357763797037ba6Wey-Yi Guy#define ASLP_TOUT(T) cpu_to_le32(T) 747af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define TU_TO_USEC 1024 757af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define SLP_TOUT(T) cpu_to_le32((T) * TU_TO_USEC) 767af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg#define SLP_VEC(X0, X1, X2, X3, X4) {cpu_to_le32(X0), \ 777af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg cpu_to_le32(X1), \ 787af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg cpu_to_le32(X2), \ 797af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg cpu_to_le32(X3), \ 807af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Berg cpu_to_le32(X4)} 815da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas/* default power management (not Tx power) table values */ 82e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg/* for DTIM period 0 through IWL_DTIM_RANGE_0_MAX */ 834ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy/* DTIM 0 - 2 */ 847af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Bergstatic const struct iwl_power_vec_entry range_0[IWL_POWER_NUM] = { 854ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy {{SLP, SLP_TOUT(200), SLP_TOUT(500), SLP_VEC(1, 1, 2, 2, 0xFF)}, 0}, 865da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(300), SLP_VEC(1, 2, 2, 2, 0xFF)}, 0}, 875da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(100), SLP_VEC(2, 2, 2, 2, 0xFF)}, 0}, 885da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(25), SLP_VEC(2, 2, 4, 4, 0xFF)}, 1}, 895da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(25), SLP_TOUT(25), SLP_VEC(2, 2, 4, 6, 0xFF)}, 2} 905da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas}; 915da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 925da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 93e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg/* for DTIM period IWL_DTIM_RANGE_0_MAX + 1 through IWL_DTIM_RANGE_1_MAX */ 944ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy/* DTIM 3 - 10 */ 957af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Bergstatic const struct iwl_power_vec_entry range_1[IWL_POWER_NUM] = { 965da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(500), SLP_VEC(1, 2, 3, 4, 4)}, 0}, 975da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(300), SLP_VEC(1, 2, 3, 4, 7)}, 0}, 985da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(100), SLP_VEC(2, 4, 6, 7, 9)}, 0}, 995da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(25), SLP_VEC(2, 4, 6, 9, 10)}, 1}, 1004ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy {{SLP, SLP_TOUT(25), SLP_TOUT(25), SLP_VEC(2, 4, 6, 10, 10)}, 2} 1015da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas}; 1025da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 103e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg/* for DTIM period > IWL_DTIM_RANGE_1_MAX */ 1044ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy/* DTIM 11 - */ 1057af2c460789a78d9c0d4dc7776fcb87acdc71052Johannes Bergstatic const struct iwl_power_vec_entry range_2[IWL_POWER_NUM] = { 1065da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(500), SLP_VEC(1, 2, 3, 4, 0xFF)}, 0}, 1075da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(200), SLP_TOUT(300), SLP_VEC(2, 4, 6, 7, 0xFF)}, 0}, 1085da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(100), SLP_VEC(2, 7, 9, 9, 0xFF)}, 0}, 1095da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(50), SLP_TOUT(25), SLP_VEC(2, 7, 9, 9, 0xFF)}, 0}, 1105da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas {{SLP, SLP_TOUT(25), SLP_TOUT(25), SLP_VEC(4, 7, 10, 10, 0xFF)}, 0} 1115da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas}; 1125da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 11335162ba75900209755628ccf7357763797037ba6Wey-Yi Guy/* advance power management */ 11435162ba75900209755628ccf7357763797037ba6Wey-Yi Guy/* DTIM 0 - 2 */ 11535162ba75900209755628ccf7357763797037ba6Wey-Yi Guystatic const struct iwl_power_vec_entry apm_range_0[IWL_POWER_NUM] = { 11635162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 11735162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 11835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 11935162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 12035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 12135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 12235162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 12335162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 12435162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 12535162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 6, 8, 0xFF), ASLP_TOUT(2)}, 2} 12635162ba75900209755628ccf7357763797037ba6Wey-Yi Guy}; 12735162ba75900209755628ccf7357763797037ba6Wey-Yi Guy 12835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy 12935162ba75900209755628ccf7357763797037ba6Wey-Yi Guy/* for DTIM period IWL_DTIM_RANGE_0_MAX + 1 through IWL_DTIM_RANGE_1_MAX */ 13035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy/* DTIM 3 - 10 */ 13135162ba75900209755628ccf7357763797037ba6Wey-Yi Guystatic const struct iwl_power_vec_entry apm_range_1[IWL_POWER_NUM] = { 13235162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 13335162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 13435162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 13535162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 13635162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 13735162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 13835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 13935162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 14035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 14135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 6, 8, 0xFF), 0}, 2} 14235162ba75900209755628ccf7357763797037ba6Wey-Yi Guy}; 14335162ba75900209755628ccf7357763797037ba6Wey-Yi Guy 14435162ba75900209755628ccf7357763797037ba6Wey-Yi Guy/* for DTIM period > IWL_DTIM_RANGE_1_MAX */ 14535162ba75900209755628ccf7357763797037ba6Wey-Yi Guy/* DTIM 11 - */ 14635162ba75900209755628ccf7357763797037ba6Wey-Yi Guystatic const struct iwl_power_vec_entry apm_range_2[IWL_POWER_NUM] = { 14735162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 14835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 14935162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 15035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 15135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 15235162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 15335162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 15435162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 4, 6, 0xFF), 0}, 0}, 15535162ba75900209755628ccf7357763797037ba6Wey-Yi Guy {{ASLP, 0, 0, ASLP_TOUT(50), ASLP_TOUT(50), 15635162ba75900209755628ccf7357763797037ba6Wey-Yi Guy SLP_VEC(1, 2, 6, 8, 0xFF), ASLP_TOUT(2)}, 2} 15735162ba75900209755628ccf7357763797037ba6Wey-Yi Guy}; 15835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy 159e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstatic void iwl_static_sleep_cmd(struct iwl_priv *priv, 160e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg struct iwl_powertable_cmd *cmd, 161e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg enum iwl_power_level lvl, int period) 162e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg{ 163e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg const struct iwl_power_vec_entry *table; 1644ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy int max_sleep[IWL_POWER_VEC_SIZE] = { 0 }; 1654ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy int i; 1664ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy u8 skip; 1674ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy u32 slp_itrvl; 168e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 1690d8877a10d65f3c9bb84ad150e524d95ebd377fbJohannes Berg if (priv->lib->adv_pm) { 17035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy table = apm_range_2; 17135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy if (period <= IWL_DTIM_RANGE_1_MAX) 17235162ba75900209755628ccf7357763797037ba6Wey-Yi Guy table = apm_range_1; 17335162ba75900209755628ccf7357763797037ba6Wey-Yi Guy if (period <= IWL_DTIM_RANGE_0_MAX) 17435162ba75900209755628ccf7357763797037ba6Wey-Yi Guy table = apm_range_0; 17535162ba75900209755628ccf7357763797037ba6Wey-Yi Guy } else { 17635162ba75900209755628ccf7357763797037ba6Wey-Yi Guy table = range_2; 17735162ba75900209755628ccf7357763797037ba6Wey-Yi Guy if (period <= IWL_DTIM_RANGE_1_MAX) 17835162ba75900209755628ccf7357763797037ba6Wey-Yi Guy table = range_1; 17935162ba75900209755628ccf7357763797037ba6Wey-Yi Guy if (period <= IWL_DTIM_RANGE_0_MAX) 18035162ba75900209755628ccf7357763797037ba6Wey-Yi Guy table = range_0; 18135162ba75900209755628ccf7357763797037ba6Wey-Yi Guy } 182e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 1833e41ace5deef7af16dd277d9d17f9d36dca0a10eJohannes Berg if (WARN_ON(lvl < 0 || lvl >= IWL_POWER_NUM)) 1843e41ace5deef7af16dd277d9d17f9d36dca0a10eJohannes Berg memset(cmd, 0, sizeof(*cmd)); 1853e41ace5deef7af16dd277d9d17f9d36dca0a10eJohannes Berg else 1863e41ace5deef7af16dd277d9d17f9d36dca0a10eJohannes Berg *cmd = table[lvl].cmd; 187e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 188e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg if (period == 0) { 1894ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy skip = 0; 190e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg period = 1; 1914ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy for (i = 0; i < IWL_POWER_VEC_SIZE; i++) 1924ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy max_sleep[i] = 1; 1934ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy 194e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg } else { 1954ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy skip = table[lvl].no_dtim; 1964ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy for (i = 0; i < IWL_POWER_VEC_SIZE; i++) 1974ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy max_sleep[i] = le32_to_cpu(cmd->sleep_interval[i]); 1984ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy max_sleep[IWL_POWER_VEC_SIZE - 1] = skip + 1; 199e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg } 200e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 2014ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy slp_itrvl = le32_to_cpu(cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1]); 2024ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy /* figure out the listen interval based on dtim period and skip */ 2034ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (slp_itrvl == 0xFF) 2044ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1] = 2054ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cpu_to_le32(period * (skip + 1)); 2064ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy 2074ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy slp_itrvl = le32_to_cpu(cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1]); 2084ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (slp_itrvl > period) 2094ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1] = 2104ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cpu_to_le32((slp_itrvl / period) * period); 2114ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy 2124ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (skip) 213e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags |= IWL_POWER_SLEEP_OVER_DTIM_MSK; 2144ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy else 215e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags &= ~IWL_POWER_SLEEP_OVER_DTIM_MSK; 216e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 2172152268ff9119c16447f6bf6e61b02df796960fdEmmanuel Grumbach if (priv->cfg->base_params->shadow_reg_enable) 2181f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy cmd->flags |= IWL_POWER_SHADOW_REG_ENA; 2191f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy else 2201f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy cmd->flags &= ~IWL_POWER_SHADOW_REG_ENA; 2211f37daf3233ccda5072f715d6c322d84833cdd92Wey-Yi Guy 22288e58fc5d940c3463c7070a2a7a8a0ce65af3fdcStanislaw Gruszka if (iwl_advanced_bt_coexist(priv)) { 2230d8877a10d65f3c9bb84ad150e524d95ebd377fbJohannes Berg if (!priv->lib->bt_params->bt_sco_disable) 224e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy cmd->flags |= IWL_POWER_BT_SCO_ENA; 225e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy else 226e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy cmd->flags &= ~IWL_POWER_BT_SCO_ENA; 227e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy } 228e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy 229e366176e5c7f37d2d4cd0708e63b939e3fa3b5c6Wey-Yi Guy 2304ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy slp_itrvl = le32_to_cpu(cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1]); 231570af86e0ab7e7b42b2562ff3209c16ab1ebd5f8Wey-Yi Guy if (slp_itrvl > IWL_CONN_MAX_LISTEN_INTERVAL) 2324ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[IWL_POWER_VEC_SIZE - 1] = 233570af86e0ab7e7b42b2562ff3209c16ab1ebd5f8Wey-Yi Guy cpu_to_le32(IWL_CONN_MAX_LISTEN_INTERVAL); 2344ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy 2354ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy /* enforce max sleep interval */ 2364ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy for (i = IWL_POWER_VEC_SIZE - 1; i >= 0 ; i--) { 2374ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (le32_to_cpu(cmd->sleep_interval[i]) > 2384ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy (max_sleep[i] * period)) 2394ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[i] = 2404ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cpu_to_le32(max_sleep[i] * period); 2414ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (i != (IWL_POWER_VEC_SIZE - 1)) { 2424ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy if (le32_to_cpu(cmd->sleep_interval[i]) > 2434ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy le32_to_cpu(cmd->sleep_interval[i+1])) 2444ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[i] = 2454ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy cmd->sleep_interval[i+1]; 2464ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy } 2474ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy } 248e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 249d57fa99d91bd6e8ca8217c115824b2732f4d3639Wey-Yi Guy if (priv->power_data.bus_pm) 250e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags |= IWL_POWER_PCI_PM_MSK; 251e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg else 252e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags &= ~IWL_POWER_PCI_PM_MSK; 253e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 2544ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy IWL_DEBUG_POWER(priv, "numSkipDtim = %u, dtimPeriod = %d\n", 2554ad177b5c860dc0b1083eccc55957daf4a116b90Wey-Yi Guy skip, period); 25611e116517be13da44da99f9532cfc23d08d9efb4Amit Beka /* The power level here is 0-4 (used as array index), but user expects 25711e116517be13da44da99f9532cfc23d08d9efb4Amit Beka to see 1-5 (according to spec). */ 258e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_DEBUG_POWER(priv, "Sleep command for index %d\n", lvl + 1); 259e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg} 260e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 261e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstatic void iwl_power_sleep_cam_cmd(struct iwl_priv *priv, 262e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg struct iwl_powertable_cmd *cmd) 2635da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas{ 264e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg memset(cmd, 0, sizeof(*cmd)); 2655da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 266d57fa99d91bd6e8ca8217c115824b2732f4d3639Wey-Yi Guy if (priv->power_data.bus_pm) 267e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg cmd->flags |= IWL_POWER_PCI_PM_MSK; 2685da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 269e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_DEBUG_POWER(priv, "Sleep command for CAM\n"); 2705da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas} 2715da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 272e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Bergstatic int iwl_set_power(struct iwl_priv *priv, struct iwl_powertable_cmd *cmd) 273e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg{ 274e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg IWL_DEBUG_POWER(priv, "Sending power/sleep command\n"); 275e1623446bb1de1834ff1c57b3e8ed341d5d4a927Tomas Winkler IWL_DEBUG_POWER(priv, "Flags value = 0x%08X\n", cmd->flags); 276e1623446bb1de1834ff1c57b3e8ed341d5d4a927Tomas Winkler IWL_DEBUG_POWER(priv, "Tx timeout = %u\n", le32_to_cpu(cmd->tx_data_timeout)); 277e1623446bb1de1834ff1c57b3e8ed341d5d4a927Tomas Winkler IWL_DEBUG_POWER(priv, "Rx timeout = %u\n", le32_to_cpu(cmd->rx_data_timeout)); 278e1623446bb1de1834ff1c57b3e8ed341d5d4a927Tomas Winkler IWL_DEBUG_POWER(priv, "Sleep interval vector = { %d , %d , %d , %d , %d }\n", 2795da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[0]), 2805da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[1]), 2815da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[2]), 2825da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[3]), 2835da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas le32_to_cpu(cmd->sleep_interval[4])); 2845da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 285a10229271946731959b2269370d0492d88cfab23Emmanuel Grumbach return iwl_dvm_send_cmd_pdu(priv, POWER_TABLE_CMD, 0, 286e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg sizeof(struct iwl_powertable_cmd), cmd); 2875da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas} 2885da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 289ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszkastatic void iwl_power_build_cmd(struct iwl_priv *priv, 290ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka struct iwl_powertable_cmd *cmd) 2915da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas{ 2924d6959219bb71aa34383fc1a1a520820aee6292bJohannes Berg bool enabled = priv->hw->conf.flags & IEEE80211_CONF_PS; 293e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg int dtimper; 2945da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 295c9e38e770981ff25d203f0f5c1423a863c484446Andy Lutomirski if (force_cam) { 296c9e38e770981ff25d203f0f5c1423a863c484446Andy Lutomirski iwl_power_sleep_cam_cmd(priv, cmd); 297c9e38e770981ff25d203f0f5c1423a863c484446Andy Lutomirski return; 298c9e38e770981ff25d203f0f5c1423a863c484446Andy Lutomirski } 299c9e38e770981ff25d203f0f5c1423a863c484446Andy Lutomirski 3003a065ab3b57bedefa1d59c88f731da6513ac482aJohannes Berg dtimper = priv->hw->conf.ps_dtim_period ?: 1; 301e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg 30215b86bff995525a38126eb44a951765a57ea2f4cJohannes Berg if (priv->wowlan) 303c8ac61cf6e53fefb3b439fc58390fb65d2730e63Johannes Berg iwl_static_sleep_cmd(priv, cmd, IWL_POWER_INDEX_5, dtimper); 3040d8877a10d65f3c9bb84ad150e524d95ebd377fbJohannes Berg else if (!priv->lib->no_idle_support && 305f35291082294ca6737953bbe4e9491ede04ab822Wey-Yi Guy priv->hw->conf.flags & IEEE80211_CONF_IDLE) 306ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_static_sleep_cmd(priv, cmd, IWL_POWER_INDEX_5, 20); 307f42e7662815647c1a6f73e160abcdf812d3057d2Wey-Yi Guy else if (iwl_tt_is_low_power_state(priv)) { 3086ddbf8cd39dc1faee7ba60337b11eb02edfcbee6Wey-Yi Guy /* in thermal throttling low power state */ 309ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_static_sleep_cmd(priv, cmd, 310f42e7662815647c1a6f73e160abcdf812d3057d2Wey-Yi Guy iwl_tt_current_power_mode(priv), dtimper); 3110975cc8fbf5b61b188734f2edd9e588c7edff2a1Wey-Yi Guy } else if (!enabled) 312ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_power_sleep_cam_cmd(priv, cmd); 313e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg else if (priv->power_data.debug_sleep_level_override >= 0) 314ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_static_sleep_cmd(priv, cmd, 315e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg priv->power_data.debug_sleep_level_override, 316e312c24cf8229f9b6e76dbfd5d99eefe21f4ac0aJohannes Berg dtimper); 31784965795b2908f2e0be929e71b5bf3b7c6ad5329Johannes Berg else { 31811e116517be13da44da99f9532cfc23d08d9efb4Amit Beka /* Note that the user parameter is 1-5 (according to spec), 31911e116517be13da44da99f9532cfc23d08d9efb4Amit Beka but we pass 0-4 because it acts as an array index. */ 32065de7e84fdc71a409f1d97aba8e44ece26628f51Johannes Berg if (iwlwifi_mod_params.power_level > IWL_POWER_INDEX_1 && 32111e116517be13da44da99f9532cfc23d08d9efb4Amit Beka iwlwifi_mod_params.power_level <= IWL_POWER_NUM) 322f7538168915271083070a60ebb10def11fce0cb0Wey-Yi Guy iwl_static_sleep_cmd(priv, cmd, 32311e116517be13da44da99f9532cfc23d08d9efb4Amit Beka iwlwifi_mod_params.power_level - 1, dtimper); 324f7538168915271083070a60ebb10def11fce0cb0Wey-Yi Guy else 325f7538168915271083070a60ebb10def11fce0cb0Wey-Yi Guy iwl_static_sleep_cmd(priv, cmd, 326f7538168915271083070a60ebb10def11fce0cb0Wey-Yi Guy IWL_POWER_INDEX_1, dtimper); 32784965795b2908f2e0be929e71b5bf3b7c6ad5329Johannes Berg } 328ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka} 329ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 330ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszkaint iwl_power_set_mode(struct iwl_priv *priv, struct iwl_powertable_cmd *cmd, 331ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka bool force) 332ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka{ 333ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka int ret; 334ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka bool update_chains; 335ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 336b1eea297d6b522b801c95b60b1e64fb61228c6c7Johannes Berg lockdep_assert_held(&priv->mutex); 337ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 338ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka /* Don't update the RX chain when chain noise calibration is running */ 339ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka update_chains = priv->chain_noise_data.state == IWL_CHAIN_NOISE_DONE || 340ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka priv->chain_noise_data.state == IWL_CHAIN_NOISE_ALIVE; 341ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 342ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (!memcmp(&priv->power_data.sleep_cmd, cmd, sizeof(*cmd)) && !force) 343ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka return 0; 344ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 34583626404a70da74c67f32f119e53c0ba032ba2d8Don Fry if (!iwl_is_ready_rf(priv)) 346ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka return -EIO; 347ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 348ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka /* scan complete use sleep_power_next, need to be updated */ 349ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka memcpy(&priv->power_data.sleep_cmd_next, cmd, sizeof(*cmd)); 35083626404a70da74c67f32f119e53c0ba032ba2d8Don Fry if (test_bit(STATUS_SCANNING, &priv->status) && !force) { 351ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka IWL_DEBUG_INFO(priv, "Defer power set mode while scanning\n"); 352ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka return 0; 353ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka } 354ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 355ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (cmd->flags & IWL_POWER_DRIVER_ALLOW_SLEEP_MSK) 35647107e84446f4724d25c724493679cc50eeef53cDon Fry iwl_dvm_set_pmi(priv, true); 3575da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 358ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka ret = iwl_set_power(priv, cmd); 359ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (!ret) { 360ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka if (!(cmd->flags & IWL_POWER_DRIVER_ALLOW_SLEEP_MSK)) 36147107e84446f4724d25c724493679cc50eeef53cDon Fry iwl_dvm_set_pmi(priv, false); 362ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 3636b6db91c8aa14fa9bd041321026d69b9f6ea42ffFry, Donald H if (update_chains) 3646b6db91c8aa14fa9bd041321026d69b9f6ea42ffFry, Donald H iwl_update_chain_flags(priv); 3656b6db91c8aa14fa9bd041321026d69b9f6ea42ffFry, Donald H else 366ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka IWL_DEBUG_POWER(priv, 3673a780d25428a0a391a8ba6c888cf4e89ac3fdbb1Wey-Yi Guy "Cannot update the power, chain noise " 368a71c8f62d46e4496011182658dc058303960c068Winkler, Tomas "calibration running: %d\n", 369a71c8f62d46e4496011182658dc058303960c068Winkler, Tomas priv->chain_noise_data.state); 370ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 371ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka memcpy(&priv->power_data.sleep_cmd, cmd, sizeof(*cmd)); 372ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka } else 3733c6acb614d841cafbcfc3d3015400b0f6849b7afJohannes Berg IWL_ERR(priv, "set power fail, ret = %d\n", ret); 3745da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 3755da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas return ret; 3765da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas} 377ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 378ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszkaint iwl_power_update_mode(struct iwl_priv *priv, bool force) 379ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka{ 380ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka struct iwl_powertable_cmd cmd; 381ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka 382ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka iwl_power_build_cmd(priv, &cmd); 383ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka return iwl_power_set_mode(priv, &cmd, force); 384ac4f5457c7617999967e9740f8903b922714bab4Stanislaw Gruszka} 3855da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas 386a96a27f97f2bbfc1fca54bc3c0b0d41484152740Tomas Winkler/* initialize to default */ 3875da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbasvoid iwl_power_initialize(struct iwl_priv *priv) 3885da4b55f78fb2ed40926b775d4f7c791594ecbd7Mohamed Abbas{ 38968e8dfdadb424fd76ca81eeb399c3228adc5cea2Emmanuel Grumbach priv->power_data.bus_pm = priv->trans->pm_support; 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} 396