diff options
author | Wey-Yi Guy <wey-yi.w.guy@intel.com> | 2010-07-31 11:34:07 -0400 |
---|---|---|
committer | John W. Linville <linville@tuxdriver.com> | 2010-08-24 16:28:07 -0400 |
commit | 0975cc8fbf5b61b188734f2edd9e588c7edff2a1 (patch) | |
tree | 9ea25bdc70467af87ba49c2a55128cc999647046 /drivers/net/wireless/iwlwifi/iwl-agn-tt.c | |
parent | 36d344131c154c0fb7dd6a3703fc1b29c56a75a1 (diff) |
iwlwifi: separate thermal throttling function
"Thermal Throttling" is an advance feature which only available for
newer _agn devices. Move from iwl-core to iwl-agn for better code
organization.
Signed-off-by: Wey-Yi Guy <wey-yi.w.guy@intel.com>
Signed-off-by: John W. Linville <linville@tuxdriver.com>
Diffstat (limited to 'drivers/net/wireless/iwlwifi/iwl-agn-tt.c')
-rw-r--r-- | drivers/net/wireless/iwlwifi/iwl-agn-tt.c | 696 |
1 files changed, 696 insertions, 0 deletions
diff --git a/drivers/net/wireless/iwlwifi/iwl-agn-tt.c b/drivers/net/wireless/iwlwifi/iwl-agn-tt.c new file mode 100644 index 000000000000..30298ea56a24 --- /dev/null +++ b/drivers/net/wireless/iwlwifi/iwl-agn-tt.c | |||
@@ -0,0 +1,696 @@ | |||
1 | /****************************************************************************** | ||
2 | * | ||
3 | * Copyright(c) 2007 - 2010 Intel Corporation. All rights reserved. | ||
4 | * | ||
5 | * Portions of this file are derived from the ipw3945 project, as well | ||
6 | * as portions of the ieee80211 subsystem header files. | ||
7 | * | ||
8 | * This program is free software; you can redistribute it and/or modify it | ||
9 | * under the terms of version 2 of the GNU General Public License as | ||
10 | * published by the Free Software Foundation. | ||
11 | * | ||
12 | * This program is distributed in the hope that it will be useful, but WITHOUT | ||
13 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | ||
14 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | ||
15 | * more details. | ||
16 | * | ||
17 | * You should have received a copy of the GNU General Public License along with | ||
18 | * this program; if not, write to the Free Software Foundation, Inc., | ||
19 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA | ||
20 | * | ||
21 | * The full GNU General Public License is included in this distribution in the | ||
22 | * file called LICENSE. | ||
23 | * | ||
24 | * Contact Information: | ||
25 | * Intel Linux Wireless <ilw@linux.intel.com> | ||
26 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 | ||
27 | *****************************************************************************/ | ||
28 | |||
29 | |||
30 | #include <linux/kernel.h> | ||
31 | #include <linux/module.h> | ||
32 | #include <linux/slab.h> | ||
33 | #include <linux/init.h> | ||
34 | |||
35 | #include <net/mac80211.h> | ||
36 | |||
37 | #include "iwl-eeprom.h" | ||
38 | #include "iwl-dev.h" | ||
39 | #include "iwl-core.h" | ||
40 | #include "iwl-io.h" | ||
41 | #include "iwl-commands.h" | ||
42 | #include "iwl-debug.h" | ||
43 | #include "iwl-agn-tt.h" | ||
44 | |||
45 | /* default Thermal Throttling transaction table | ||
46 | * Current state | Throttling Down | Throttling Up | ||
47 | *============================================================================= | ||
48 | * Condition Nxt State Condition Nxt State Condition Nxt State | ||
49 | *----------------------------------------------------------------------------- | ||
50 | * IWL_TI_0 T >= 114 CT_KILL 114>T>=105 TI_1 N/A N/A | ||
51 | * IWL_TI_1 T >= 114 CT_KILL 114>T>=110 TI_2 T<=95 TI_0 | ||
52 | * IWL_TI_2 T >= 114 CT_KILL T<=100 TI_1 | ||
53 | * IWL_CT_KILL N/A N/A N/A N/A T<=95 TI_0 | ||
54 | *============================================================================= | ||
55 | */ | ||
56 | static const struct iwl_tt_trans tt_range_0[IWL_TI_STATE_MAX - 1] = { | ||
57 | {IWL_TI_0, IWL_ABSOLUTE_ZERO, 104}, | ||
58 | {IWL_TI_1, 105, CT_KILL_THRESHOLD - 1}, | ||
59 | {IWL_TI_CT_KILL, CT_KILL_THRESHOLD, IWL_ABSOLUTE_MAX} | ||
60 | }; | ||
61 | static const struct iwl_tt_trans tt_range_1[IWL_TI_STATE_MAX - 1] = { | ||
62 | {IWL_TI_0, IWL_ABSOLUTE_ZERO, 95}, | ||
63 | {IWL_TI_2, 110, CT_KILL_THRESHOLD - 1}, | ||
64 | {IWL_TI_CT_KILL, CT_KILL_THRESHOLD, IWL_ABSOLUTE_MAX} | ||
65 | }; | ||
66 | static const struct iwl_tt_trans tt_range_2[IWL_TI_STATE_MAX - 1] = { | ||
67 | {IWL_TI_1, IWL_ABSOLUTE_ZERO, 100}, | ||
68 | {IWL_TI_CT_KILL, CT_KILL_THRESHOLD, IWL_ABSOLUTE_MAX}, | ||
69 | {IWL_TI_CT_KILL, CT_KILL_THRESHOLD, IWL_ABSOLUTE_MAX} | ||
70 | }; | ||
71 | static const struct iwl_tt_trans tt_range_3[IWL_TI_STATE_MAX - 1] = { | ||
72 | {IWL_TI_0, IWL_ABSOLUTE_ZERO, CT_KILL_EXIT_THRESHOLD}, | ||
73 | {IWL_TI_CT_KILL, CT_KILL_EXIT_THRESHOLD + 1, IWL_ABSOLUTE_MAX}, | ||
74 | {IWL_TI_CT_KILL, CT_KILL_EXIT_THRESHOLD + 1, IWL_ABSOLUTE_MAX} | ||
75 | }; | ||
76 | |||
77 | /* Advance Thermal Throttling default restriction table */ | ||
78 | static const struct iwl_tt_restriction restriction_range[IWL_TI_STATE_MAX] = { | ||
79 | {IWL_ANT_OK_MULTI, IWL_ANT_OK_MULTI, true }, | ||
80 | {IWL_ANT_OK_SINGLE, IWL_ANT_OK_MULTI, true }, | ||
81 | {IWL_ANT_OK_SINGLE, IWL_ANT_OK_SINGLE, false }, | ||
82 | {IWL_ANT_OK_NONE, IWL_ANT_OK_NONE, false } | ||
83 | }; | ||
84 | |||
85 | bool iwl_tt_is_low_power_state(struct iwl_priv *priv) | ||
86 | { | ||
87 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
88 | |||
89 | if (tt->state >= IWL_TI_1) | ||
90 | return true; | ||
91 | return false; | ||
92 | } | ||
93 | |||
94 | u8 iwl_tt_current_power_mode(struct iwl_priv *priv) | ||
95 | { | ||
96 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
97 | |||
98 | return tt->tt_power_mode; | ||
99 | } | ||
100 | |||
101 | bool iwl_ht_enabled(struct iwl_priv *priv) | ||
102 | { | ||
103 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
104 | struct iwl_tt_restriction *restriction; | ||
105 | |||
106 | if (!priv->thermal_throttle.advanced_tt) | ||
107 | return true; | ||
108 | restriction = tt->restriction + tt->state; | ||
109 | return restriction->is_ht; | ||
110 | } | ||
111 | |||
112 | static bool iwl_within_ct_kill_margin(struct iwl_priv *priv) | ||
113 | { | ||
114 | s32 temp = priv->temperature; /* degrees CELSIUS except specified */ | ||
115 | bool within_margin = false; | ||
116 | |||
117 | if (priv->cfg->temperature_kelvin) | ||
118 | temp = KELVIN_TO_CELSIUS(priv->temperature); | ||
119 | |||
120 | if (!priv->thermal_throttle.advanced_tt) | ||
121 | within_margin = ((temp + IWL_TT_CT_KILL_MARGIN) >= | ||
122 | CT_KILL_THRESHOLD_LEGACY) ? true : false; | ||
123 | else | ||
124 | within_margin = ((temp + IWL_TT_CT_KILL_MARGIN) >= | ||
125 | CT_KILL_THRESHOLD) ? true : false; | ||
126 | return within_margin; | ||
127 | } | ||
128 | |||
129 | bool iwl_check_for_ct_kill(struct iwl_priv *priv) | ||
130 | { | ||
131 | bool is_ct_kill = false; | ||
132 | |||
133 | if (iwl_within_ct_kill_margin(priv)) { | ||
134 | iwl_tt_enter_ct_kill(priv); | ||
135 | is_ct_kill = true; | ||
136 | } | ||
137 | return is_ct_kill; | ||
138 | } | ||
139 | |||
140 | enum iwl_antenna_ok iwl_tx_ant_restriction(struct iwl_priv *priv) | ||
141 | { | ||
142 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
143 | struct iwl_tt_restriction *restriction; | ||
144 | |||
145 | if (!priv->thermal_throttle.advanced_tt) | ||
146 | return IWL_ANT_OK_MULTI; | ||
147 | restriction = tt->restriction + tt->state; | ||
148 | return restriction->tx_stream; | ||
149 | } | ||
150 | |||
151 | enum iwl_antenna_ok iwl_rx_ant_restriction(struct iwl_priv *priv) | ||
152 | { | ||
153 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
154 | struct iwl_tt_restriction *restriction; | ||
155 | |||
156 | if (!priv->thermal_throttle.advanced_tt) | ||
157 | return IWL_ANT_OK_MULTI; | ||
158 | restriction = tt->restriction + tt->state; | ||
159 | return restriction->rx_stream; | ||
160 | } | ||
161 | |||
162 | #define CT_KILL_EXIT_DURATION (5) /* 5 seconds duration */ | ||
163 | #define CT_KILL_WAITING_DURATION (300) /* 300ms duration */ | ||
164 | |||
165 | /* | ||
166 | * toggle the bit to wake up uCode and check the temperature | ||
167 | * if the temperature is below CT, uCode will stay awake and send card | ||
168 | * state notification with CT_KILL bit clear to inform Thermal Throttling | ||
169 | * Management to change state. Otherwise, uCode will go back to sleep | ||
170 | * without doing anything, driver should continue the 5 seconds timer | ||
171 | * to wake up uCode for temperature check until temperature drop below CT | ||
172 | */ | ||
173 | static void iwl_tt_check_exit_ct_kill(unsigned long data) | ||
174 | { | ||
175 | struct iwl_priv *priv = (struct iwl_priv *)data; | ||
176 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
177 | unsigned long flags; | ||
178 | |||
179 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
180 | return; | ||
181 | |||
182 | if (tt->state == IWL_TI_CT_KILL) { | ||
183 | if (priv->thermal_throttle.ct_kill_toggle) { | ||
184 | iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR, | ||
185 | CSR_UCODE_DRV_GP1_REG_BIT_CT_KILL_EXIT); | ||
186 | priv->thermal_throttle.ct_kill_toggle = false; | ||
187 | } else { | ||
188 | iwl_write32(priv, CSR_UCODE_DRV_GP1_SET, | ||
189 | CSR_UCODE_DRV_GP1_REG_BIT_CT_KILL_EXIT); | ||
190 | priv->thermal_throttle.ct_kill_toggle = true; | ||
191 | } | ||
192 | iwl_read32(priv, CSR_UCODE_DRV_GP1); | ||
193 | spin_lock_irqsave(&priv->reg_lock, flags); | ||
194 | if (!iwl_grab_nic_access(priv)) | ||
195 | iwl_release_nic_access(priv); | ||
196 | spin_unlock_irqrestore(&priv->reg_lock, flags); | ||
197 | |||
198 | /* Reschedule the ct_kill timer to occur in | ||
199 | * CT_KILL_EXIT_DURATION seconds to ensure we get a | ||
200 | * thermal update */ | ||
201 | IWL_DEBUG_POWER(priv, "schedule ct_kill exit timer\n"); | ||
202 | mod_timer(&priv->thermal_throttle.ct_kill_exit_tm, | ||
203 | jiffies + CT_KILL_EXIT_DURATION * HZ); | ||
204 | } | ||
205 | } | ||
206 | |||
207 | static void iwl_perform_ct_kill_task(struct iwl_priv *priv, | ||
208 | bool stop) | ||
209 | { | ||
210 | if (stop) { | ||
211 | IWL_DEBUG_POWER(priv, "Stop all queues\n"); | ||
212 | if (priv->mac80211_registered) | ||
213 | ieee80211_stop_queues(priv->hw); | ||
214 | IWL_DEBUG_POWER(priv, | ||
215 | "Schedule 5 seconds CT_KILL Timer\n"); | ||
216 | mod_timer(&priv->thermal_throttle.ct_kill_exit_tm, | ||
217 | jiffies + CT_KILL_EXIT_DURATION * HZ); | ||
218 | } else { | ||
219 | IWL_DEBUG_POWER(priv, "Wake all queues\n"); | ||
220 | if (priv->mac80211_registered) | ||
221 | ieee80211_wake_queues(priv->hw); | ||
222 | } | ||
223 | } | ||
224 | |||
225 | static void iwl_tt_ready_for_ct_kill(unsigned long data) | ||
226 | { | ||
227 | struct iwl_priv *priv = (struct iwl_priv *)data; | ||
228 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
229 | |||
230 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
231 | return; | ||
232 | |||
233 | /* temperature timer expired, ready to go into CT_KILL state */ | ||
234 | if (tt->state != IWL_TI_CT_KILL) { | ||
235 | IWL_DEBUG_POWER(priv, "entering CT_KILL state when " | ||
236 | "temperature timer expired\n"); | ||
237 | tt->state = IWL_TI_CT_KILL; | ||
238 | set_bit(STATUS_CT_KILL, &priv->status); | ||
239 | iwl_perform_ct_kill_task(priv, true); | ||
240 | } | ||
241 | } | ||
242 | |||
243 | static void iwl_prepare_ct_kill_task(struct iwl_priv *priv) | ||
244 | { | ||
245 | IWL_DEBUG_POWER(priv, "Prepare to enter IWL_TI_CT_KILL\n"); | ||
246 | /* make request to retrieve statistics information */ | ||
247 | iwl_send_statistics_request(priv, CMD_SYNC, false); | ||
248 | /* Reschedule the ct_kill wait timer */ | ||
249 | mod_timer(&priv->thermal_throttle.ct_kill_waiting_tm, | ||
250 | jiffies + msecs_to_jiffies(CT_KILL_WAITING_DURATION)); | ||
251 | } | ||
252 | |||
253 | #define IWL_MINIMAL_POWER_THRESHOLD (CT_KILL_THRESHOLD_LEGACY) | ||
254 | #define IWL_REDUCED_PERFORMANCE_THRESHOLD_2 (100) | ||
255 | #define IWL_REDUCED_PERFORMANCE_THRESHOLD_1 (90) | ||
256 | |||
257 | /* | ||
258 | * Legacy thermal throttling | ||
259 | * 1) Avoid NIC destruction due to high temperatures | ||
260 | * Chip will identify dangerously high temperatures that can | ||
261 | * harm the device and will power down | ||
262 | * 2) Avoid the NIC power down due to high temperature | ||
263 | * Throttle early enough to lower the power consumption before | ||
264 | * drastic steps are needed | ||
265 | */ | ||
266 | static void iwl_legacy_tt_handler(struct iwl_priv *priv, s32 temp, bool force) | ||
267 | { | ||
268 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
269 | enum iwl_tt_state old_state; | ||
270 | |||
271 | #ifdef CONFIG_IWLWIFI_DEBUG | ||
272 | if ((tt->tt_previous_temp) && | ||
273 | (temp > tt->tt_previous_temp) && | ||
274 | ((temp - tt->tt_previous_temp) > | ||
275 | IWL_TT_INCREASE_MARGIN)) { | ||
276 | IWL_DEBUG_POWER(priv, | ||
277 | "Temperature increase %d degree Celsius\n", | ||
278 | (temp - tt->tt_previous_temp)); | ||
279 | } | ||
280 | #endif | ||
281 | old_state = tt->state; | ||
282 | /* in Celsius */ | ||
283 | if (temp >= IWL_MINIMAL_POWER_THRESHOLD) | ||
284 | tt->state = IWL_TI_CT_KILL; | ||
285 | else if (temp >= IWL_REDUCED_PERFORMANCE_THRESHOLD_2) | ||
286 | tt->state = IWL_TI_2; | ||
287 | else if (temp >= IWL_REDUCED_PERFORMANCE_THRESHOLD_1) | ||
288 | tt->state = IWL_TI_1; | ||
289 | else | ||
290 | tt->state = IWL_TI_0; | ||
291 | |||
292 | #ifdef CONFIG_IWLWIFI_DEBUG | ||
293 | tt->tt_previous_temp = temp; | ||
294 | #endif | ||
295 | /* stop ct_kill_waiting_tm timer */ | ||
296 | del_timer_sync(&priv->thermal_throttle.ct_kill_waiting_tm); | ||
297 | if (tt->state != old_state) { | ||
298 | switch (tt->state) { | ||
299 | case IWL_TI_0: | ||
300 | /* | ||
301 | * When the system is ready to go back to IWL_TI_0 | ||
302 | * we only have to call iwl_power_update_mode() to | ||
303 | * do so. | ||
304 | */ | ||
305 | break; | ||
306 | case IWL_TI_1: | ||
307 | tt->tt_power_mode = IWL_POWER_INDEX_3; | ||
308 | break; | ||
309 | case IWL_TI_2: | ||
310 | tt->tt_power_mode = IWL_POWER_INDEX_4; | ||
311 | break; | ||
312 | default: | ||
313 | tt->tt_power_mode = IWL_POWER_INDEX_5; | ||
314 | break; | ||
315 | } | ||
316 | mutex_lock(&priv->mutex); | ||
317 | if (old_state == IWL_TI_CT_KILL) | ||
318 | clear_bit(STATUS_CT_KILL, &priv->status); | ||
319 | if (tt->state != IWL_TI_CT_KILL && | ||
320 | iwl_power_update_mode(priv, true)) { | ||
321 | /* TT state not updated | ||
322 | * try again during next temperature read | ||
323 | */ | ||
324 | if (old_state == IWL_TI_CT_KILL) | ||
325 | set_bit(STATUS_CT_KILL, &priv->status); | ||
326 | tt->state = old_state; | ||
327 | IWL_ERR(priv, "Cannot update power mode, " | ||
328 | "TT state not updated\n"); | ||
329 | } else { | ||
330 | if (tt->state == IWL_TI_CT_KILL) { | ||
331 | if (force) { | ||
332 | set_bit(STATUS_CT_KILL, &priv->status); | ||
333 | iwl_perform_ct_kill_task(priv, true); | ||
334 | } else { | ||
335 | iwl_prepare_ct_kill_task(priv); | ||
336 | tt->state = old_state; | ||
337 | } | ||
338 | } else if (old_state == IWL_TI_CT_KILL && | ||
339 | tt->state != IWL_TI_CT_KILL) | ||
340 | iwl_perform_ct_kill_task(priv, false); | ||
341 | IWL_DEBUG_POWER(priv, "Temperature state changed %u\n", | ||
342 | tt->state); | ||
343 | IWL_DEBUG_POWER(priv, "Power Index change to %u\n", | ||
344 | tt->tt_power_mode); | ||
345 | } | ||
346 | mutex_unlock(&priv->mutex); | ||
347 | } | ||
348 | } | ||
349 | |||
350 | /* | ||
351 | * Advance thermal throttling | ||
352 | * 1) Avoid NIC destruction due to high temperatures | ||
353 | * Chip will identify dangerously high temperatures that can | ||
354 | * harm the device and will power down | ||
355 | * 2) Avoid the NIC power down due to high temperature | ||
356 | * Throttle early enough to lower the power consumption before | ||
357 | * drastic steps are needed | ||
358 | * Actions include relaxing the power down sleep thresholds and | ||
359 | * decreasing the number of TX streams | ||
360 | * 3) Avoid throughput performance impact as much as possible | ||
361 | * | ||
362 | *============================================================================= | ||
363 | * Condition Nxt State Condition Nxt State Condition Nxt State | ||
364 | *----------------------------------------------------------------------------- | ||
365 | * IWL_TI_0 T >= 114 CT_KILL 114>T>=105 TI_1 N/A N/A | ||
366 | * IWL_TI_1 T >= 114 CT_KILL 114>T>=110 TI_2 T<=95 TI_0 | ||
367 | * IWL_TI_2 T >= 114 CT_KILL T<=100 TI_1 | ||
368 | * IWL_CT_KILL N/A N/A N/A N/A T<=95 TI_0 | ||
369 | *============================================================================= | ||
370 | */ | ||
371 | static void iwl_advance_tt_handler(struct iwl_priv *priv, s32 temp, bool force) | ||
372 | { | ||
373 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
374 | int i; | ||
375 | bool changed = false; | ||
376 | enum iwl_tt_state old_state; | ||
377 | struct iwl_tt_trans *transaction; | ||
378 | |||
379 | old_state = tt->state; | ||
380 | for (i = 0; i < IWL_TI_STATE_MAX - 1; i++) { | ||
381 | /* based on the current TT state, | ||
382 | * find the curresponding transaction table | ||
383 | * each table has (IWL_TI_STATE_MAX - 1) entries | ||
384 | * tt->transaction + ((old_state * (IWL_TI_STATE_MAX - 1)) | ||
385 | * will advance to the correct table. | ||
386 | * then based on the current temperature | ||
387 | * find the next state need to transaction to | ||
388 | * go through all the possible (IWL_TI_STATE_MAX - 1) entries | ||
389 | * in the current table to see if transaction is needed | ||
390 | */ | ||
391 | transaction = tt->transaction + | ||
392 | ((old_state * (IWL_TI_STATE_MAX - 1)) + i); | ||
393 | if (temp >= transaction->tt_low && | ||
394 | temp <= transaction->tt_high) { | ||
395 | #ifdef CONFIG_IWLWIFI_DEBUG | ||
396 | if ((tt->tt_previous_temp) && | ||
397 | (temp > tt->tt_previous_temp) && | ||
398 | ((temp - tt->tt_previous_temp) > | ||
399 | IWL_TT_INCREASE_MARGIN)) { | ||
400 | IWL_DEBUG_POWER(priv, | ||
401 | "Temperature increase %d " | ||
402 | "degree Celsius\n", | ||
403 | (temp - tt->tt_previous_temp)); | ||
404 | } | ||
405 | tt->tt_previous_temp = temp; | ||
406 | #endif | ||
407 | if (old_state != | ||
408 | transaction->next_state) { | ||
409 | changed = true; | ||
410 | tt->state = | ||
411 | transaction->next_state; | ||
412 | } | ||
413 | break; | ||
414 | } | ||
415 | } | ||
416 | /* stop ct_kill_waiting_tm timer */ | ||
417 | del_timer_sync(&priv->thermal_throttle.ct_kill_waiting_tm); | ||
418 | if (changed) { | ||
419 | struct iwl_rxon_cmd *rxon = &priv->staging_rxon; | ||
420 | |||
421 | if (tt->state >= IWL_TI_1) { | ||
422 | /* force PI = IWL_POWER_INDEX_5 in the case of TI > 0 */ | ||
423 | tt->tt_power_mode = IWL_POWER_INDEX_5; | ||
424 | if (!iwl_ht_enabled(priv)) | ||
425 | /* disable HT */ | ||
426 | rxon->flags &= ~(RXON_FLG_CHANNEL_MODE_MSK | | ||
427 | RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK | | ||
428 | RXON_FLG_HT40_PROT_MSK | | ||
429 | RXON_FLG_HT_PROT_MSK); | ||
430 | else { | ||
431 | /* check HT capability and set | ||
432 | * according to the system HT capability | ||
433 | * in case get disabled before */ | ||
434 | iwl_set_rxon_ht(priv, &priv->current_ht_config); | ||
435 | } | ||
436 | |||
437 | } else { | ||
438 | /* | ||
439 | * restore system power setting -- it will be | ||
440 | * recalculated automatically. | ||
441 | */ | ||
442 | |||
443 | /* check HT capability and set | ||
444 | * according to the system HT capability | ||
445 | * in case get disabled before */ | ||
446 | iwl_set_rxon_ht(priv, &priv->current_ht_config); | ||
447 | } | ||
448 | mutex_lock(&priv->mutex); | ||
449 | if (old_state == IWL_TI_CT_KILL) | ||
450 | clear_bit(STATUS_CT_KILL, &priv->status); | ||
451 | if (tt->state != IWL_TI_CT_KILL && | ||
452 | iwl_power_update_mode(priv, true)) { | ||
453 | /* TT state not updated | ||
454 | * try again during next temperature read | ||
455 | */ | ||
456 | IWL_ERR(priv, "Cannot update power mode, " | ||
457 | "TT state not updated\n"); | ||
458 | if (old_state == IWL_TI_CT_KILL) | ||
459 | set_bit(STATUS_CT_KILL, &priv->status); | ||
460 | tt->state = old_state; | ||
461 | } else { | ||
462 | IWL_DEBUG_POWER(priv, | ||
463 | "Thermal Throttling to new state: %u\n", | ||
464 | tt->state); | ||
465 | if (old_state != IWL_TI_CT_KILL && | ||
466 | tt->state == IWL_TI_CT_KILL) { | ||
467 | if (force) { | ||
468 | IWL_DEBUG_POWER(priv, | ||
469 | "Enter IWL_TI_CT_KILL\n"); | ||
470 | set_bit(STATUS_CT_KILL, &priv->status); | ||
471 | iwl_perform_ct_kill_task(priv, true); | ||
472 | } else { | ||
473 | iwl_prepare_ct_kill_task(priv); | ||
474 | tt->state = old_state; | ||
475 | } | ||
476 | } else if (old_state == IWL_TI_CT_KILL && | ||
477 | tt->state != IWL_TI_CT_KILL) { | ||
478 | IWL_DEBUG_POWER(priv, "Exit IWL_TI_CT_KILL\n"); | ||
479 | iwl_perform_ct_kill_task(priv, false); | ||
480 | } | ||
481 | } | ||
482 | mutex_unlock(&priv->mutex); | ||
483 | } | ||
484 | } | ||
485 | |||
486 | /* Card State Notification indicated reach critical temperature | ||
487 | * if PSP not enable, no Thermal Throttling function will be performed | ||
488 | * just set the GP1 bit to acknowledge the event | ||
489 | * otherwise, go into IWL_TI_CT_KILL state | ||
490 | * since Card State Notification will not provide any temperature reading | ||
491 | * for Legacy mode | ||
492 | * so just pass the CT_KILL temperature to iwl_legacy_tt_handler() | ||
493 | * for advance mode | ||
494 | * pass CT_KILL_THRESHOLD+1 to make sure move into IWL_TI_CT_KILL state | ||
495 | */ | ||
496 | static void iwl_bg_ct_enter(struct work_struct *work) | ||
497 | { | ||
498 | struct iwl_priv *priv = container_of(work, struct iwl_priv, ct_enter); | ||
499 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
500 | |||
501 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
502 | return; | ||
503 | |||
504 | if (!iwl_is_ready(priv)) | ||
505 | return; | ||
506 | |||
507 | if (tt->state != IWL_TI_CT_KILL) { | ||
508 | IWL_ERR(priv, "Device reached critical temperature " | ||
509 | "- ucode going to sleep!\n"); | ||
510 | if (!priv->thermal_throttle.advanced_tt) | ||
511 | iwl_legacy_tt_handler(priv, | ||
512 | IWL_MINIMAL_POWER_THRESHOLD, | ||
513 | true); | ||
514 | else | ||
515 | iwl_advance_tt_handler(priv, | ||
516 | CT_KILL_THRESHOLD + 1, true); | ||
517 | } | ||
518 | } | ||
519 | |||
520 | /* Card State Notification indicated out of critical temperature | ||
521 | * since Card State Notification will not provide any temperature reading | ||
522 | * so pass the IWL_REDUCED_PERFORMANCE_THRESHOLD_2 temperature | ||
523 | * to iwl_legacy_tt_handler() to get out of IWL_CT_KILL state | ||
524 | */ | ||
525 | static void iwl_bg_ct_exit(struct work_struct *work) | ||
526 | { | ||
527 | struct iwl_priv *priv = container_of(work, struct iwl_priv, ct_exit); | ||
528 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
529 | |||
530 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
531 | return; | ||
532 | |||
533 | if (!iwl_is_ready(priv)) | ||
534 | return; | ||
535 | |||
536 | /* stop ct_kill_exit_tm timer */ | ||
537 | del_timer_sync(&priv->thermal_throttle.ct_kill_exit_tm); | ||
538 | |||
539 | if (tt->state == IWL_TI_CT_KILL) { | ||
540 | IWL_ERR(priv, | ||
541 | "Device temperature below critical" | ||
542 | "- ucode awake!\n"); | ||
543 | /* | ||
544 | * exit from CT_KILL state | ||
545 | * reset the current temperature reading | ||
546 | */ | ||
547 | priv->temperature = 0; | ||
548 | if (!priv->thermal_throttle.advanced_tt) | ||
549 | iwl_legacy_tt_handler(priv, | ||
550 | IWL_REDUCED_PERFORMANCE_THRESHOLD_2, | ||
551 | true); | ||
552 | else | ||
553 | iwl_advance_tt_handler(priv, CT_KILL_EXIT_THRESHOLD, | ||
554 | true); | ||
555 | } | ||
556 | } | ||
557 | |||
558 | void iwl_tt_enter_ct_kill(struct iwl_priv *priv) | ||
559 | { | ||
560 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
561 | return; | ||
562 | |||
563 | IWL_DEBUG_POWER(priv, "Queueing critical temperature enter.\n"); | ||
564 | queue_work(priv->workqueue, &priv->ct_enter); | ||
565 | } | ||
566 | EXPORT_SYMBOL(iwl_tt_enter_ct_kill); | ||
567 | |||
568 | void iwl_tt_exit_ct_kill(struct iwl_priv *priv) | ||
569 | { | ||
570 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
571 | return; | ||
572 | |||
573 | IWL_DEBUG_POWER(priv, "Queueing critical temperature exit.\n"); | ||
574 | queue_work(priv->workqueue, &priv->ct_exit); | ||
575 | } | ||
576 | EXPORT_SYMBOL(iwl_tt_exit_ct_kill); | ||
577 | |||
578 | static void iwl_bg_tt_work(struct work_struct *work) | ||
579 | { | ||
580 | struct iwl_priv *priv = container_of(work, struct iwl_priv, tt_work); | ||
581 | s32 temp = priv->temperature; /* degrees CELSIUS except specified */ | ||
582 | |||
583 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
584 | return; | ||
585 | |||
586 | if (priv->cfg->temperature_kelvin) | ||
587 | temp = KELVIN_TO_CELSIUS(priv->temperature); | ||
588 | |||
589 | if (!priv->thermal_throttle.advanced_tt) | ||
590 | iwl_legacy_tt_handler(priv, temp, false); | ||
591 | else | ||
592 | iwl_advance_tt_handler(priv, temp, false); | ||
593 | } | ||
594 | |||
595 | void iwl_tt_handler(struct iwl_priv *priv) | ||
596 | { | ||
597 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
598 | return; | ||
599 | |||
600 | IWL_DEBUG_POWER(priv, "Queueing thermal throttling work.\n"); | ||
601 | queue_work(priv->workqueue, &priv->tt_work); | ||
602 | } | ||
603 | EXPORT_SYMBOL(iwl_tt_handler); | ||
604 | |||
605 | /* Thermal throttling initialization | ||
606 | * For advance thermal throttling: | ||
607 | * Initialize Thermal Index and temperature threshold table | ||
608 | * Initialize thermal throttling restriction table | ||
609 | */ | ||
610 | void iwl_tt_initialize(struct iwl_priv *priv) | ||
611 | { | ||
612 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
613 | int size = sizeof(struct iwl_tt_trans) * (IWL_TI_STATE_MAX - 1); | ||
614 | struct iwl_tt_trans *transaction; | ||
615 | |||
616 | IWL_DEBUG_POWER(priv, "Initialize Thermal Throttling\n"); | ||
617 | |||
618 | memset(tt, 0, sizeof(struct iwl_tt_mgmt)); | ||
619 | |||
620 | tt->state = IWL_TI_0; | ||
621 | init_timer(&priv->thermal_throttle.ct_kill_exit_tm); | ||
622 | priv->thermal_throttle.ct_kill_exit_tm.data = (unsigned long)priv; | ||
623 | priv->thermal_throttle.ct_kill_exit_tm.function = | ||
624 | iwl_tt_check_exit_ct_kill; | ||
625 | init_timer(&priv->thermal_throttle.ct_kill_waiting_tm); | ||
626 | priv->thermal_throttle.ct_kill_waiting_tm.data = | ||
627 | (unsigned long)priv; | ||
628 | priv->thermal_throttle.ct_kill_waiting_tm.function = | ||
629 | iwl_tt_ready_for_ct_kill; | ||
630 | /* setup deferred ct kill work */ | ||
631 | INIT_WORK(&priv->tt_work, iwl_bg_tt_work); | ||
632 | INIT_WORK(&priv->ct_enter, iwl_bg_ct_enter); | ||
633 | INIT_WORK(&priv->ct_exit, iwl_bg_ct_exit); | ||
634 | |||
635 | if (priv->cfg->adv_thermal_throttle) { | ||
636 | IWL_DEBUG_POWER(priv, "Advanced Thermal Throttling\n"); | ||
637 | tt->restriction = kzalloc(sizeof(struct iwl_tt_restriction) * | ||
638 | IWL_TI_STATE_MAX, GFP_KERNEL); | ||
639 | tt->transaction = kzalloc(sizeof(struct iwl_tt_trans) * | ||
640 | IWL_TI_STATE_MAX * (IWL_TI_STATE_MAX - 1), | ||
641 | GFP_KERNEL); | ||
642 | if (!tt->restriction || !tt->transaction) { | ||
643 | IWL_ERR(priv, "Fallback to Legacy Throttling\n"); | ||
644 | priv->thermal_throttle.advanced_tt = false; | ||
645 | kfree(tt->restriction); | ||
646 | tt->restriction = NULL; | ||
647 | kfree(tt->transaction); | ||
648 | tt->transaction = NULL; | ||
649 | } else { | ||
650 | transaction = tt->transaction + | ||
651 | (IWL_TI_0 * (IWL_TI_STATE_MAX - 1)); | ||
652 | memcpy(transaction, &tt_range_0[0], size); | ||
653 | transaction = tt->transaction + | ||
654 | (IWL_TI_1 * (IWL_TI_STATE_MAX - 1)); | ||
655 | memcpy(transaction, &tt_range_1[0], size); | ||
656 | transaction = tt->transaction + | ||
657 | (IWL_TI_2 * (IWL_TI_STATE_MAX - 1)); | ||
658 | memcpy(transaction, &tt_range_2[0], size); | ||
659 | transaction = tt->transaction + | ||
660 | (IWL_TI_CT_KILL * (IWL_TI_STATE_MAX - 1)); | ||
661 | memcpy(transaction, &tt_range_3[0], size); | ||
662 | size = sizeof(struct iwl_tt_restriction) * | ||
663 | IWL_TI_STATE_MAX; | ||
664 | memcpy(tt->restriction, | ||
665 | &restriction_range[0], size); | ||
666 | priv->thermal_throttle.advanced_tt = true; | ||
667 | } | ||
668 | } else { | ||
669 | IWL_DEBUG_POWER(priv, "Legacy Thermal Throttling\n"); | ||
670 | priv->thermal_throttle.advanced_tt = false; | ||
671 | } | ||
672 | } | ||
673 | EXPORT_SYMBOL(iwl_tt_initialize); | ||
674 | |||
675 | /* cleanup thermal throttling management related memory and timer */ | ||
676 | void iwl_tt_exit(struct iwl_priv *priv) | ||
677 | { | ||
678 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
679 | |||
680 | /* stop ct_kill_exit_tm timer if activated */ | ||
681 | del_timer_sync(&priv->thermal_throttle.ct_kill_exit_tm); | ||
682 | /* stop ct_kill_waiting_tm timer if activated */ | ||
683 | del_timer_sync(&priv->thermal_throttle.ct_kill_waiting_tm); | ||
684 | cancel_work_sync(&priv->tt_work); | ||
685 | cancel_work_sync(&priv->ct_enter); | ||
686 | cancel_work_sync(&priv->ct_exit); | ||
687 | |||
688 | if (priv->thermal_throttle.advanced_tt) { | ||
689 | /* free advance thermal throttling memory */ | ||
690 | kfree(tt->restriction); | ||
691 | tt->restriction = NULL; | ||
692 | kfree(tt->transaction); | ||
693 | tt->transaction = NULL; | ||
694 | } | ||
695 | } | ||
696 | EXPORT_SYMBOL(iwl_tt_exit); | ||