iwlwifi: mvm: downgrade to old power management API
[firefly-linux-kernel-4.4.55.git] / drivers / net / wireless / iwlwifi / mvm / power.c
1 /******************************************************************************
2  *
3  * This file is provided under a dual BSD/GPLv2 license.  When using or
4  * redistributing this file, you may do so under either license.
5  *
6  * GPL LICENSE SUMMARY
7  *
8  * Copyright(c) 2012 - 2013 Intel Corporation. All rights reserved.
9  *
10  * This program is free software; you can redistribute it and/or modify
11  * it under the terms of version 2 of the GNU General Public License as
12  * published by the Free Software Foundation.
13  *
14  * This program is distributed in the hope that it will be useful, but
15  * WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
17  * General Public License for more details.
18  *
19  * You should have received a copy of the GNU General Public License
20  * along with this program; if not, write to the Free Software
21  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
22  * USA
23  *
24  * The full GNU General Public License is included in this distribution
25  * in the file called COPYING.
26  *
27  * Contact Information:
28  *  Intel Linux Wireless <ilw@linux.intel.com>
29  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
30  *
31  * BSD LICENSE
32  *
33  * Copyright(c) 2012 - 2013 Intel Corporation. All rights reserved.
34  * All rights reserved.
35  *
36  * Redistribution and use in source and binary forms, with or without
37  * modification, are permitted provided that the following conditions
38  * are met:
39  *
40  *  * Redistributions of source code must retain the above copyright
41  *    notice, this list of conditions and the following disclaimer.
42  *  * Redistributions in binary form must reproduce the above copyright
43  *    notice, this list of conditions and the following disclaimer in
44  *    the documentation and/or other materials provided with the
45  *    distribution.
46  *  * Neither the name Intel Corporation nor the names of its
47  *    contributors may be used to endorse or promote products derived
48  *    from this software without specific prior written permission.
49  *
50  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
51  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
52  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
53  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
54  * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
55  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
56  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
57  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
58  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
59  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
60  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
61  *
62  *****************************************************************************/
63
64 #include <linux/kernel.h>
65 #include <linux/module.h>
66 #include <linux/slab.h>
67 #include <linux/init.h>
68
69 #include <net/mac80211.h>
70
71 #include "iwl-debug.h"
72 #include "mvm.h"
73 #include "iwl-modparams.h"
74 #include "fw-api-power.h"
75
76 #define POWER_KEEP_ALIVE_PERIOD_SEC    25
77
78 static void iwl_power_build_cmd(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
79                                 struct iwl_powertable_cmd *cmd)
80 {
81         struct ieee80211_hw *hw = mvm->hw;
82         struct ieee80211_chanctx_conf *chanctx_conf;
83         struct ieee80211_channel *chan;
84         int dtimper, dtimper_msec;
85         int keep_alive;
86         bool radar_detect = false;
87
88         if ((!vif->bss_conf.ps) ||
89             (iwlmvm_mod_params.power_scheme == IWL_POWER_SCHEME_CAM))
90                 return;
91
92         cmd->flags |= cpu_to_le16(POWER_FLAGS_POWER_MANAGEMENT_ENA_MSK |
93                                   POWER_FLAGS_POWER_SAVE_ENA_MSK);
94
95         dtimper = hw->conf.ps_dtim_period ?: 1;
96
97         /* Check if radar detection is required on current channel */
98         rcu_read_lock();
99         chanctx_conf = rcu_dereference(vif->chanctx_conf);
100         WARN_ON(!chanctx_conf);
101         if (chanctx_conf) {
102                 chan = chanctx_conf->def.chan;
103                 radar_detect = chan->flags & IEEE80211_CHAN_RADAR;
104         }
105         rcu_read_unlock();
106
107         /* Check skip over DTIM conditions */
108         if (!radar_detect && (dtimper <= 10) &&
109             (iwlmvm_mod_params.power_scheme == IWL_POWER_SCHEME_LP))
110                 cmd->flags |= cpu_to_le16(POWER_FLAGS_SLEEP_OVER_DTIM_MSK);
111
112         /* Check that keep alive period is at least 3 * DTIM */
113         dtimper_msec = dtimper * vif->bss_conf.beacon_int;
114         keep_alive = max_t(int, 3 * dtimper_msec,
115                            MSEC_PER_SEC * POWER_KEEP_ALIVE_PERIOD_SEC);
116         keep_alive = DIV_ROUND_UP(keep_alive, MSEC_PER_SEC);
117
118         cmd->keep_alive_seconds = keep_alive;
119
120         if (iwlmvm_mod_params.power_scheme == IWL_POWER_SCHEME_LP) {
121                 /* TODO: Also for D3 (device sleep / WoWLAN) */
122                 cmd->rx_data_timeout = cpu_to_le32(10);
123                 cmd->tx_data_timeout = cpu_to_le32(10);
124         } else {
125                 cmd->rx_data_timeout = cpu_to_le32(50);
126                 cmd->tx_data_timeout = cpu_to_le32(50);
127         }
128 }
129
130 int iwl_mvm_power_update_mode(struct iwl_mvm *mvm, struct ieee80211_vif *vif)
131 {
132         struct iwl_powertable_cmd cmd = {};
133
134         if (!iwlwifi_mod_params.power_save) {
135                 IWL_DEBUG_POWER(mvm, "Power management is not allowed\n");
136                 return 0;
137         }
138
139         if (vif->type != NL80211_IFTYPE_STATION || vif->p2p)
140                 return 0;
141
142         iwl_power_build_cmd(mvm, vif, &cmd);
143
144         IWL_DEBUG_POWER(mvm,
145                         "Sending power table command for power level %d, flags = 0x%X\n",
146                         iwlmvm_mod_params.power_scheme, le16_to_cpu(cmd.flags));
147
148         if (cmd.flags & cpu_to_le16(POWER_FLAGS_POWER_MANAGEMENT_ENA_MSK)) {
149                 IWL_DEBUG_POWER(mvm, "Keep alive = %u sec\n",
150                                 cmd.keep_alive_seconds);
151                 IWL_DEBUG_POWER(mvm, "Rx timeout = %u usec\n",
152                                 le32_to_cpu(cmd.rx_data_timeout));
153                 IWL_DEBUG_POWER(mvm, "Tx timeout = %u usec\n",
154                                 le32_to_cpu(cmd.tx_data_timeout));
155                 IWL_DEBUG_POWER(mvm, "LP RX RSSI threshold = %u\n",
156                                 cmd.lprx_rssi_threshold);
157         }
158
159         return iwl_mvm_send_cmd_pdu(mvm, POWER_TABLE_CMD, CMD_SYNC,
160                                     sizeof(cmd), &cmd);
161 }
162
163 int iwl_mvm_power_disable(struct iwl_mvm *mvm, struct ieee80211_vif *vif)
164 {
165         struct iwl_powertable_cmd cmd = {};
166
167         if (!iwlwifi_mod_params.power_save) {
168                 IWL_DEBUG_POWER(mvm, "Power management is not allowed\n");
169                 return 0;
170         }
171
172         if (vif->type != NL80211_IFTYPE_STATION || vif->p2p)
173                 return 0;
174
175         IWL_DEBUG_POWER(mvm,
176                         "Sending power table command power level %d, flags = 0x%X\n",
177                         iwlmvm_mod_params.power_scheme, le16_to_cpu(cmd.flags));
178
179         return iwl_mvm_send_cmd_pdu(mvm, POWER_TABLE_CMD, CMD_ASYNC,
180                                     sizeof(cmd), &cmd);
181 }
182
183 #ifdef CONFIG_IWLWIFI_DEBUGFS
184 void iwl_power_get_params(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
185                           struct iwl_powertable_cmd *cmd)
186 {
187         iwl_power_build_cmd(mvm, vif, cmd);
188 }
189 #endif /* CONFIG_IWLWIFI_DEBUGFS */