diff options
Diffstat (limited to 'drivers/net/wireless/iwlwifi/iwl-power.c')
-rw-r--r-- | drivers/net/wireless/iwlwifi/iwl-power.c | 638 |
1 files changed, 7 insertions, 631 deletions
diff --git a/drivers/net/wireless/iwlwifi/iwl-power.c b/drivers/net/wireless/iwlwifi/iwl-power.c index cda6a94d6cc9..63c0ab46261f 100644 --- a/drivers/net/wireless/iwlwifi/iwl-power.c +++ b/drivers/net/wireless/iwlwifi/iwl-power.c | |||
@@ -192,47 +192,6 @@ static void iwl_static_sleep_cmd(struct iwl_priv *priv, | |||
192 | IWL_DEBUG_POWER(priv, "Sleep command for index %d\n", lvl + 1); | 192 | IWL_DEBUG_POWER(priv, "Sleep command for index %d\n", lvl + 1); |
193 | } | 193 | } |
194 | 194 | ||
195 | /* default Thermal Throttling transaction table | ||
196 | * Current state | Throttling Down | Throttling Up | ||
197 | *============================================================================= | ||
198 | * Condition Nxt State Condition Nxt State Condition Nxt State | ||
199 | *----------------------------------------------------------------------------- | ||
200 | * IWL_TI_0 T >= 114 CT_KILL 114>T>=105 TI_1 N/A N/A | ||
201 | * IWL_TI_1 T >= 114 CT_KILL 114>T>=110 TI_2 T<=95 TI_0 | ||
202 | * IWL_TI_2 T >= 114 CT_KILL T<=100 TI_1 | ||
203 | * IWL_CT_KILL N/A N/A N/A N/A T<=95 TI_0 | ||
204 | *============================================================================= | ||
205 | */ | ||
206 | static const struct iwl_tt_trans tt_range_0[IWL_TI_STATE_MAX - 1] = { | ||
207 | {IWL_TI_0, IWL_ABSOLUTE_ZERO, 104}, | ||
208 | {IWL_TI_1, 105, CT_KILL_THRESHOLD - 1}, | ||
209 | {IWL_TI_CT_KILL, CT_KILL_THRESHOLD, IWL_ABSOLUTE_MAX} | ||
210 | }; | ||
211 | static const struct iwl_tt_trans tt_range_1[IWL_TI_STATE_MAX - 1] = { | ||
212 | {IWL_TI_0, IWL_ABSOLUTE_ZERO, 95}, | ||
213 | {IWL_TI_2, 110, CT_KILL_THRESHOLD - 1}, | ||
214 | {IWL_TI_CT_KILL, CT_KILL_THRESHOLD, IWL_ABSOLUTE_MAX} | ||
215 | }; | ||
216 | static const struct iwl_tt_trans tt_range_2[IWL_TI_STATE_MAX - 1] = { | ||
217 | {IWL_TI_1, IWL_ABSOLUTE_ZERO, 100}, | ||
218 | {IWL_TI_CT_KILL, CT_KILL_THRESHOLD, IWL_ABSOLUTE_MAX}, | ||
219 | {IWL_TI_CT_KILL, CT_KILL_THRESHOLD, IWL_ABSOLUTE_MAX} | ||
220 | }; | ||
221 | static const struct iwl_tt_trans tt_range_3[IWL_TI_STATE_MAX - 1] = { | ||
222 | {IWL_TI_0, IWL_ABSOLUTE_ZERO, CT_KILL_EXIT_THRESHOLD}, | ||
223 | {IWL_TI_CT_KILL, CT_KILL_EXIT_THRESHOLD + 1, IWL_ABSOLUTE_MAX}, | ||
224 | {IWL_TI_CT_KILL, CT_KILL_EXIT_THRESHOLD + 1, IWL_ABSOLUTE_MAX} | ||
225 | }; | ||
226 | |||
227 | /* Advance Thermal Throttling default restriction table */ | ||
228 | static const struct iwl_tt_restriction restriction_range[IWL_TI_STATE_MAX] = { | ||
229 | {IWL_ANT_OK_MULTI, IWL_ANT_OK_MULTI, true }, | ||
230 | {IWL_ANT_OK_SINGLE, IWL_ANT_OK_MULTI, true }, | ||
231 | {IWL_ANT_OK_SINGLE, IWL_ANT_OK_SINGLE, false }, | ||
232 | {IWL_ANT_OK_NONE, IWL_ANT_OK_NONE, false } | ||
233 | }; | ||
234 | |||
235 | |||
236 | static void iwl_power_sleep_cam_cmd(struct iwl_priv *priv, | 195 | static void iwl_power_sleep_cam_cmd(struct iwl_priv *priv, |
237 | struct iwl_powertable_cmd *cmd) | 196 | struct iwl_powertable_cmd *cmd) |
238 | { | 197 | { |
@@ -308,7 +267,6 @@ static int iwl_set_power(struct iwl_priv *priv, struct iwl_powertable_cmd *cmd) | |||
308 | int iwl_power_update_mode(struct iwl_priv *priv, bool force) | 267 | int iwl_power_update_mode(struct iwl_priv *priv, bool force) |
309 | { | 268 | { |
310 | int ret = 0; | 269 | int ret = 0; |
311 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
312 | bool enabled = priv->hw->conf.flags & IEEE80211_CONF_PS; | 270 | bool enabled = priv->hw->conf.flags & IEEE80211_CONF_PS; |
313 | bool update_chains; | 271 | bool update_chains; |
314 | struct iwl_powertable_cmd cmd; | 272 | struct iwl_powertable_cmd cmd; |
@@ -325,9 +283,13 @@ int iwl_power_update_mode(struct iwl_priv *priv, bool force) | |||
325 | else if (priv->cfg->supports_idle && | 283 | else if (priv->cfg->supports_idle && |
326 | priv->hw->conf.flags & IEEE80211_CONF_IDLE) | 284 | priv->hw->conf.flags & IEEE80211_CONF_IDLE) |
327 | iwl_static_sleep_cmd(priv, &cmd, IWL_POWER_INDEX_5, 20); | 285 | iwl_static_sleep_cmd(priv, &cmd, IWL_POWER_INDEX_5, 20); |
328 | else if (tt->state >= IWL_TI_1) | 286 | else if (priv->cfg->ops->lib->tt_ops.lower_power_detection && |
329 | iwl_static_sleep_cmd(priv, &cmd, tt->tt_power_mode, dtimper); | 287 | priv->cfg->ops->lib->tt_ops.tt_power_mode && |
330 | else if (!enabled) | 288 | priv->cfg->ops->lib->tt_ops.lower_power_detection(priv)) { |
289 | /* in thermal throttling low power state */ | ||
290 | iwl_static_sleep_cmd(priv, &cmd, | ||
291 | priv->cfg->ops->lib->tt_ops.tt_power_mode(priv), dtimper); | ||
292 | } else if (!enabled) | ||
331 | iwl_power_sleep_cam_cmd(priv, &cmd); | 293 | iwl_power_sleep_cam_cmd(priv, &cmd); |
332 | else if (priv->power_data.debug_sleep_level_override >= 0) | 294 | else if (priv->power_data.debug_sleep_level_override >= 0) |
333 | iwl_static_sleep_cmd(priv, &cmd, | 295 | iwl_static_sleep_cmd(priv, &cmd, |
@@ -367,592 +329,6 @@ int iwl_power_update_mode(struct iwl_priv *priv, bool force) | |||
367 | } | 329 | } |
368 | EXPORT_SYMBOL(iwl_power_update_mode); | 330 | EXPORT_SYMBOL(iwl_power_update_mode); |
369 | 331 | ||
370 | bool iwl_ht_enabled(struct iwl_priv *priv) | ||
371 | { | ||
372 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
373 | struct iwl_tt_restriction *restriction; | ||
374 | |||
375 | if (!priv->thermal_throttle.advanced_tt) | ||
376 | return true; | ||
377 | restriction = tt->restriction + tt->state; | ||
378 | return restriction->is_ht; | ||
379 | } | ||
380 | EXPORT_SYMBOL(iwl_ht_enabled); | ||
381 | |||
382 | bool iwl_within_ct_kill_margin(struct iwl_priv *priv) | ||
383 | { | ||
384 | s32 temp = priv->temperature; /* degrees CELSIUS except specified */ | ||
385 | bool within_margin = false; | ||
386 | |||
387 | if (priv->cfg->temperature_kelvin) | ||
388 | temp = KELVIN_TO_CELSIUS(priv->temperature); | ||
389 | |||
390 | if (!priv->thermal_throttle.advanced_tt) | ||
391 | within_margin = ((temp + IWL_TT_CT_KILL_MARGIN) >= | ||
392 | CT_KILL_THRESHOLD_LEGACY) ? true : false; | ||
393 | else | ||
394 | within_margin = ((temp + IWL_TT_CT_KILL_MARGIN) >= | ||
395 | CT_KILL_THRESHOLD) ? true : false; | ||
396 | return within_margin; | ||
397 | } | ||
398 | |||
399 | enum iwl_antenna_ok iwl_tx_ant_restriction(struct iwl_priv *priv) | ||
400 | { | ||
401 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
402 | struct iwl_tt_restriction *restriction; | ||
403 | |||
404 | if (!priv->thermal_throttle.advanced_tt) | ||
405 | return IWL_ANT_OK_MULTI; | ||
406 | restriction = tt->restriction + tt->state; | ||
407 | return restriction->tx_stream; | ||
408 | } | ||
409 | EXPORT_SYMBOL(iwl_tx_ant_restriction); | ||
410 | |||
411 | enum iwl_antenna_ok iwl_rx_ant_restriction(struct iwl_priv *priv) | ||
412 | { | ||
413 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
414 | struct iwl_tt_restriction *restriction; | ||
415 | |||
416 | if (!priv->thermal_throttle.advanced_tt) | ||
417 | return IWL_ANT_OK_MULTI; | ||
418 | restriction = tt->restriction + tt->state; | ||
419 | return restriction->rx_stream; | ||
420 | } | ||
421 | |||
422 | #define CT_KILL_EXIT_DURATION (5) /* 5 seconds duration */ | ||
423 | #define CT_KILL_WAITING_DURATION (300) /* 300ms duration */ | ||
424 | |||
425 | /* | ||
426 | * toggle the bit to wake up uCode and check the temperature | ||
427 | * if the temperature is below CT, uCode will stay awake and send card | ||
428 | * state notification with CT_KILL bit clear to inform Thermal Throttling | ||
429 | * Management to change state. Otherwise, uCode will go back to sleep | ||
430 | * without doing anything, driver should continue the 5 seconds timer | ||
431 | * to wake up uCode for temperature check until temperature drop below CT | ||
432 | */ | ||
433 | static void iwl_tt_check_exit_ct_kill(unsigned long data) | ||
434 | { | ||
435 | struct iwl_priv *priv = (struct iwl_priv *)data; | ||
436 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
437 | unsigned long flags; | ||
438 | |||
439 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
440 | return; | ||
441 | |||
442 | if (tt->state == IWL_TI_CT_KILL) { | ||
443 | if (priv->thermal_throttle.ct_kill_toggle) { | ||
444 | iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR, | ||
445 | CSR_UCODE_DRV_GP1_REG_BIT_CT_KILL_EXIT); | ||
446 | priv->thermal_throttle.ct_kill_toggle = false; | ||
447 | } else { | ||
448 | iwl_write32(priv, CSR_UCODE_DRV_GP1_SET, | ||
449 | CSR_UCODE_DRV_GP1_REG_BIT_CT_KILL_EXIT); | ||
450 | priv->thermal_throttle.ct_kill_toggle = true; | ||
451 | } | ||
452 | iwl_read32(priv, CSR_UCODE_DRV_GP1); | ||
453 | spin_lock_irqsave(&priv->reg_lock, flags); | ||
454 | if (!iwl_grab_nic_access(priv)) | ||
455 | iwl_release_nic_access(priv); | ||
456 | spin_unlock_irqrestore(&priv->reg_lock, flags); | ||
457 | |||
458 | /* Reschedule the ct_kill timer to occur in | ||
459 | * CT_KILL_EXIT_DURATION seconds to ensure we get a | ||
460 | * thermal update */ | ||
461 | IWL_DEBUG_POWER(priv, "schedule ct_kill exit timer\n"); | ||
462 | mod_timer(&priv->thermal_throttle.ct_kill_exit_tm, jiffies + | ||
463 | CT_KILL_EXIT_DURATION * HZ); | ||
464 | } | ||
465 | } | ||
466 | |||
467 | static void iwl_perform_ct_kill_task(struct iwl_priv *priv, | ||
468 | bool stop) | ||
469 | { | ||
470 | if (stop) { | ||
471 | IWL_DEBUG_POWER(priv, "Stop all queues\n"); | ||
472 | if (priv->mac80211_registered) | ||
473 | ieee80211_stop_queues(priv->hw); | ||
474 | IWL_DEBUG_POWER(priv, | ||
475 | "Schedule 5 seconds CT_KILL Timer\n"); | ||
476 | mod_timer(&priv->thermal_throttle.ct_kill_exit_tm, jiffies + | ||
477 | CT_KILL_EXIT_DURATION * HZ); | ||
478 | } else { | ||
479 | IWL_DEBUG_POWER(priv, "Wake all queues\n"); | ||
480 | if (priv->mac80211_registered) | ||
481 | ieee80211_wake_queues(priv->hw); | ||
482 | } | ||
483 | } | ||
484 | |||
485 | static void iwl_tt_ready_for_ct_kill(unsigned long data) | ||
486 | { | ||
487 | struct iwl_priv *priv = (struct iwl_priv *)data; | ||
488 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
489 | |||
490 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
491 | return; | ||
492 | |||
493 | /* temperature timer expired, ready to go into CT_KILL state */ | ||
494 | if (tt->state != IWL_TI_CT_KILL) { | ||
495 | IWL_DEBUG_POWER(priv, "entering CT_KILL state when temperature timer expired\n"); | ||
496 | tt->state = IWL_TI_CT_KILL; | ||
497 | set_bit(STATUS_CT_KILL, &priv->status); | ||
498 | iwl_perform_ct_kill_task(priv, true); | ||
499 | } | ||
500 | } | ||
501 | |||
502 | static void iwl_prepare_ct_kill_task(struct iwl_priv *priv) | ||
503 | { | ||
504 | IWL_DEBUG_POWER(priv, "Prepare to enter IWL_TI_CT_KILL\n"); | ||
505 | /* make request to retrieve statistics information */ | ||
506 | iwl_send_statistics_request(priv, CMD_SYNC, false); | ||
507 | /* Reschedule the ct_kill wait timer */ | ||
508 | mod_timer(&priv->thermal_throttle.ct_kill_waiting_tm, | ||
509 | jiffies + msecs_to_jiffies(CT_KILL_WAITING_DURATION)); | ||
510 | } | ||
511 | |||
512 | #define IWL_MINIMAL_POWER_THRESHOLD (CT_KILL_THRESHOLD_LEGACY) | ||
513 | #define IWL_REDUCED_PERFORMANCE_THRESHOLD_2 (100) | ||
514 | #define IWL_REDUCED_PERFORMANCE_THRESHOLD_1 (90) | ||
515 | |||
516 | /* | ||
517 | * Legacy thermal throttling | ||
518 | * 1) Avoid NIC destruction due to high temperatures | ||
519 | * Chip will identify dangerously high temperatures that can | ||
520 | * harm the device and will power down | ||
521 | * 2) Avoid the NIC power down due to high temperature | ||
522 | * Throttle early enough to lower the power consumption before | ||
523 | * drastic steps are needed | ||
524 | */ | ||
525 | static void iwl_legacy_tt_handler(struct iwl_priv *priv, s32 temp, bool force) | ||
526 | { | ||
527 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
528 | enum iwl_tt_state old_state; | ||
529 | |||
530 | #ifdef CONFIG_IWLWIFI_DEBUG | ||
531 | if ((tt->tt_previous_temp) && | ||
532 | (temp > tt->tt_previous_temp) && | ||
533 | ((temp - tt->tt_previous_temp) > | ||
534 | IWL_TT_INCREASE_MARGIN)) { | ||
535 | IWL_DEBUG_POWER(priv, | ||
536 | "Temperature increase %d degree Celsius\n", | ||
537 | (temp - tt->tt_previous_temp)); | ||
538 | } | ||
539 | #endif | ||
540 | old_state = tt->state; | ||
541 | /* in Celsius */ | ||
542 | if (temp >= IWL_MINIMAL_POWER_THRESHOLD) | ||
543 | tt->state = IWL_TI_CT_KILL; | ||
544 | else if (temp >= IWL_REDUCED_PERFORMANCE_THRESHOLD_2) | ||
545 | tt->state = IWL_TI_2; | ||
546 | else if (temp >= IWL_REDUCED_PERFORMANCE_THRESHOLD_1) | ||
547 | tt->state = IWL_TI_1; | ||
548 | else | ||
549 | tt->state = IWL_TI_0; | ||
550 | |||
551 | #ifdef CONFIG_IWLWIFI_DEBUG | ||
552 | tt->tt_previous_temp = temp; | ||
553 | #endif | ||
554 | /* stop ct_kill_waiting_tm timer */ | ||
555 | del_timer_sync(&priv->thermal_throttle.ct_kill_waiting_tm); | ||
556 | if (tt->state != old_state) { | ||
557 | switch (tt->state) { | ||
558 | case IWL_TI_0: | ||
559 | /* | ||
560 | * When the system is ready to go back to IWL_TI_0 | ||
561 | * we only have to call iwl_power_update_mode() to | ||
562 | * do so. | ||
563 | */ | ||
564 | break; | ||
565 | case IWL_TI_1: | ||
566 | tt->tt_power_mode = IWL_POWER_INDEX_3; | ||
567 | break; | ||
568 | case IWL_TI_2: | ||
569 | tt->tt_power_mode = IWL_POWER_INDEX_4; | ||
570 | break; | ||
571 | default: | ||
572 | tt->tt_power_mode = IWL_POWER_INDEX_5; | ||
573 | break; | ||
574 | } | ||
575 | mutex_lock(&priv->mutex); | ||
576 | if (old_state == IWL_TI_CT_KILL) | ||
577 | clear_bit(STATUS_CT_KILL, &priv->status); | ||
578 | if (tt->state != IWL_TI_CT_KILL && | ||
579 | iwl_power_update_mode(priv, true)) { | ||
580 | /* TT state not updated | ||
581 | * try again during next temperature read | ||
582 | */ | ||
583 | if (old_state == IWL_TI_CT_KILL) | ||
584 | set_bit(STATUS_CT_KILL, &priv->status); | ||
585 | tt->state = old_state; | ||
586 | IWL_ERR(priv, "Cannot update power mode, " | ||
587 | "TT state not updated\n"); | ||
588 | } else { | ||
589 | if (tt->state == IWL_TI_CT_KILL) { | ||
590 | if (force) { | ||
591 | set_bit(STATUS_CT_KILL, &priv->status); | ||
592 | iwl_perform_ct_kill_task(priv, true); | ||
593 | } else { | ||
594 | iwl_prepare_ct_kill_task(priv); | ||
595 | tt->state = old_state; | ||
596 | } | ||
597 | } else if (old_state == IWL_TI_CT_KILL && | ||
598 | tt->state != IWL_TI_CT_KILL) | ||
599 | iwl_perform_ct_kill_task(priv, false); | ||
600 | IWL_DEBUG_POWER(priv, "Temperature state changed %u\n", | ||
601 | tt->state); | ||
602 | IWL_DEBUG_POWER(priv, "Power Index change to %u\n", | ||
603 | tt->tt_power_mode); | ||
604 | } | ||
605 | mutex_unlock(&priv->mutex); | ||
606 | } | ||
607 | } | ||
608 | |||
609 | /* | ||
610 | * Advance thermal throttling | ||
611 | * 1) Avoid NIC destruction due to high temperatures | ||
612 | * Chip will identify dangerously high temperatures that can | ||
613 | * harm the device and will power down | ||
614 | * 2) Avoid the NIC power down due to high temperature | ||
615 | * Throttle early enough to lower the power consumption before | ||
616 | * drastic steps are needed | ||
617 | * Actions include relaxing the power down sleep thresholds and | ||
618 | * decreasing the number of TX streams | ||
619 | * 3) Avoid throughput performance impact as much as possible | ||
620 | * | ||
621 | *============================================================================= | ||
622 | * Condition Nxt State Condition Nxt State Condition Nxt State | ||
623 | *----------------------------------------------------------------------------- | ||
624 | * IWL_TI_0 T >= 114 CT_KILL 114>T>=105 TI_1 N/A N/A | ||
625 | * IWL_TI_1 T >= 114 CT_KILL 114>T>=110 TI_2 T<=95 TI_0 | ||
626 | * IWL_TI_2 T >= 114 CT_KILL T<=100 TI_1 | ||
627 | * IWL_CT_KILL N/A N/A N/A N/A T<=95 TI_0 | ||
628 | *============================================================================= | ||
629 | */ | ||
630 | static void iwl_advance_tt_handler(struct iwl_priv *priv, s32 temp, bool force) | ||
631 | { | ||
632 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
633 | int i; | ||
634 | bool changed = false; | ||
635 | enum iwl_tt_state old_state; | ||
636 | struct iwl_tt_trans *transaction; | ||
637 | |||
638 | old_state = tt->state; | ||
639 | for (i = 0; i < IWL_TI_STATE_MAX - 1; i++) { | ||
640 | /* based on the current TT state, | ||
641 | * find the curresponding transaction table | ||
642 | * each table has (IWL_TI_STATE_MAX - 1) entries | ||
643 | * tt->transaction + ((old_state * (IWL_TI_STATE_MAX - 1)) | ||
644 | * will advance to the correct table. | ||
645 | * then based on the current temperature | ||
646 | * find the next state need to transaction to | ||
647 | * go through all the possible (IWL_TI_STATE_MAX - 1) entries | ||
648 | * in the current table to see if transaction is needed | ||
649 | */ | ||
650 | transaction = tt->transaction + | ||
651 | ((old_state * (IWL_TI_STATE_MAX - 1)) + i); | ||
652 | if (temp >= transaction->tt_low && | ||
653 | temp <= transaction->tt_high) { | ||
654 | #ifdef CONFIG_IWLWIFI_DEBUG | ||
655 | if ((tt->tt_previous_temp) && | ||
656 | (temp > tt->tt_previous_temp) && | ||
657 | ((temp - tt->tt_previous_temp) > | ||
658 | IWL_TT_INCREASE_MARGIN)) { | ||
659 | IWL_DEBUG_POWER(priv, | ||
660 | "Temperature increase %d " | ||
661 | "degree Celsius\n", | ||
662 | (temp - tt->tt_previous_temp)); | ||
663 | } | ||
664 | tt->tt_previous_temp = temp; | ||
665 | #endif | ||
666 | if (old_state != | ||
667 | transaction->next_state) { | ||
668 | changed = true; | ||
669 | tt->state = | ||
670 | transaction->next_state; | ||
671 | } | ||
672 | break; | ||
673 | } | ||
674 | } | ||
675 | /* stop ct_kill_waiting_tm timer */ | ||
676 | del_timer_sync(&priv->thermal_throttle.ct_kill_waiting_tm); | ||
677 | if (changed) { | ||
678 | struct iwl_rxon_cmd *rxon = &priv->staging_rxon; | ||
679 | |||
680 | if (tt->state >= IWL_TI_1) { | ||
681 | /* force PI = IWL_POWER_INDEX_5 in the case of TI > 0 */ | ||
682 | tt->tt_power_mode = IWL_POWER_INDEX_5; | ||
683 | if (!iwl_ht_enabled(priv)) | ||
684 | /* disable HT */ | ||
685 | rxon->flags &= ~(RXON_FLG_CHANNEL_MODE_MSK | | ||
686 | RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK | | ||
687 | RXON_FLG_HT40_PROT_MSK | | ||
688 | RXON_FLG_HT_PROT_MSK); | ||
689 | else { | ||
690 | /* check HT capability and set | ||
691 | * according to the system HT capability | ||
692 | * in case get disabled before */ | ||
693 | iwl_set_rxon_ht(priv, &priv->current_ht_config); | ||
694 | } | ||
695 | |||
696 | } else { | ||
697 | /* | ||
698 | * restore system power setting -- it will be | ||
699 | * recalculated automatically. | ||
700 | */ | ||
701 | |||
702 | /* check HT capability and set | ||
703 | * according to the system HT capability | ||
704 | * in case get disabled before */ | ||
705 | iwl_set_rxon_ht(priv, &priv->current_ht_config); | ||
706 | } | ||
707 | mutex_lock(&priv->mutex); | ||
708 | if (old_state == IWL_TI_CT_KILL) | ||
709 | clear_bit(STATUS_CT_KILL, &priv->status); | ||
710 | if (tt->state != IWL_TI_CT_KILL && | ||
711 | iwl_power_update_mode(priv, true)) { | ||
712 | /* TT state not updated | ||
713 | * try again during next temperature read | ||
714 | */ | ||
715 | IWL_ERR(priv, "Cannot update power mode, " | ||
716 | "TT state not updated\n"); | ||
717 | if (old_state == IWL_TI_CT_KILL) | ||
718 | set_bit(STATUS_CT_KILL, &priv->status); | ||
719 | tt->state = old_state; | ||
720 | } else { | ||
721 | IWL_DEBUG_POWER(priv, | ||
722 | "Thermal Throttling to new state: %u\n", | ||
723 | tt->state); | ||
724 | if (old_state != IWL_TI_CT_KILL && | ||
725 | tt->state == IWL_TI_CT_KILL) { | ||
726 | if (force) { | ||
727 | IWL_DEBUG_POWER(priv, | ||
728 | "Enter IWL_TI_CT_KILL\n"); | ||
729 | set_bit(STATUS_CT_KILL, &priv->status); | ||
730 | iwl_perform_ct_kill_task(priv, true); | ||
731 | } else { | ||
732 | iwl_prepare_ct_kill_task(priv); | ||
733 | tt->state = old_state; | ||
734 | } | ||
735 | } else if (old_state == IWL_TI_CT_KILL && | ||
736 | tt->state != IWL_TI_CT_KILL) { | ||
737 | IWL_DEBUG_POWER(priv, "Exit IWL_TI_CT_KILL\n"); | ||
738 | iwl_perform_ct_kill_task(priv, false); | ||
739 | } | ||
740 | } | ||
741 | mutex_unlock(&priv->mutex); | ||
742 | } | ||
743 | } | ||
744 | |||
745 | /* Card State Notification indicated reach critical temperature | ||
746 | * if PSP not enable, no Thermal Throttling function will be performed | ||
747 | * just set the GP1 bit to acknowledge the event | ||
748 | * otherwise, go into IWL_TI_CT_KILL state | ||
749 | * since Card State Notification will not provide any temperature reading | ||
750 | * for Legacy mode | ||
751 | * so just pass the CT_KILL temperature to iwl_legacy_tt_handler() | ||
752 | * for advance mode | ||
753 | * pass CT_KILL_THRESHOLD+1 to make sure move into IWL_TI_CT_KILL state | ||
754 | */ | ||
755 | static void iwl_bg_ct_enter(struct work_struct *work) | ||
756 | { | ||
757 | struct iwl_priv *priv = container_of(work, struct iwl_priv, ct_enter); | ||
758 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
759 | |||
760 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
761 | return; | ||
762 | |||
763 | if (!iwl_is_ready(priv)) | ||
764 | return; | ||
765 | |||
766 | if (tt->state != IWL_TI_CT_KILL) { | ||
767 | IWL_ERR(priv, "Device reached critical temperature " | ||
768 | "- ucode going to sleep!\n"); | ||
769 | if (!priv->thermal_throttle.advanced_tt) | ||
770 | iwl_legacy_tt_handler(priv, | ||
771 | IWL_MINIMAL_POWER_THRESHOLD, | ||
772 | true); | ||
773 | else | ||
774 | iwl_advance_tt_handler(priv, | ||
775 | CT_KILL_THRESHOLD + 1, true); | ||
776 | } | ||
777 | } | ||
778 | |||
779 | /* Card State Notification indicated out of critical temperature | ||
780 | * since Card State Notification will not provide any temperature reading | ||
781 | * so pass the IWL_REDUCED_PERFORMANCE_THRESHOLD_2 temperature | ||
782 | * to iwl_legacy_tt_handler() to get out of IWL_CT_KILL state | ||
783 | */ | ||
784 | static void iwl_bg_ct_exit(struct work_struct *work) | ||
785 | { | ||
786 | struct iwl_priv *priv = container_of(work, struct iwl_priv, ct_exit); | ||
787 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
788 | |||
789 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
790 | return; | ||
791 | |||
792 | if (!iwl_is_ready(priv)) | ||
793 | return; | ||
794 | |||
795 | /* stop ct_kill_exit_tm timer */ | ||
796 | del_timer_sync(&priv->thermal_throttle.ct_kill_exit_tm); | ||
797 | |||
798 | if (tt->state == IWL_TI_CT_KILL) { | ||
799 | IWL_ERR(priv, | ||
800 | "Device temperature below critical" | ||
801 | "- ucode awake!\n"); | ||
802 | /* | ||
803 | * exit from CT_KILL state | ||
804 | * reset the current temperature reading | ||
805 | */ | ||
806 | priv->temperature = 0; | ||
807 | if (!priv->thermal_throttle.advanced_tt) | ||
808 | iwl_legacy_tt_handler(priv, | ||
809 | IWL_REDUCED_PERFORMANCE_THRESHOLD_2, | ||
810 | true); | ||
811 | else | ||
812 | iwl_advance_tt_handler(priv, CT_KILL_EXIT_THRESHOLD, | ||
813 | true); | ||
814 | } | ||
815 | } | ||
816 | |||
817 | void iwl_tt_enter_ct_kill(struct iwl_priv *priv) | ||
818 | { | ||
819 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
820 | return; | ||
821 | |||
822 | IWL_DEBUG_POWER(priv, "Queueing critical temperature enter.\n"); | ||
823 | queue_work(priv->workqueue, &priv->ct_enter); | ||
824 | } | ||
825 | EXPORT_SYMBOL(iwl_tt_enter_ct_kill); | ||
826 | |||
827 | void iwl_tt_exit_ct_kill(struct iwl_priv *priv) | ||
828 | { | ||
829 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
830 | return; | ||
831 | |||
832 | IWL_DEBUG_POWER(priv, "Queueing critical temperature exit.\n"); | ||
833 | queue_work(priv->workqueue, &priv->ct_exit); | ||
834 | } | ||
835 | EXPORT_SYMBOL(iwl_tt_exit_ct_kill); | ||
836 | |||
837 | static void iwl_bg_tt_work(struct work_struct *work) | ||
838 | { | ||
839 | struct iwl_priv *priv = container_of(work, struct iwl_priv, tt_work); | ||
840 | s32 temp = priv->temperature; /* degrees CELSIUS except specified */ | ||
841 | |||
842 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
843 | return; | ||
844 | |||
845 | if (priv->cfg->temperature_kelvin) | ||
846 | temp = KELVIN_TO_CELSIUS(priv->temperature); | ||
847 | |||
848 | if (!priv->thermal_throttle.advanced_tt) | ||
849 | iwl_legacy_tt_handler(priv, temp, false); | ||
850 | else | ||
851 | iwl_advance_tt_handler(priv, temp, false); | ||
852 | } | ||
853 | |||
854 | void iwl_tt_handler(struct iwl_priv *priv) | ||
855 | { | ||
856 | if (test_bit(STATUS_EXIT_PENDING, &priv->status)) | ||
857 | return; | ||
858 | |||
859 | IWL_DEBUG_POWER(priv, "Queueing thermal throttling work.\n"); | ||
860 | queue_work(priv->workqueue, &priv->tt_work); | ||
861 | } | ||
862 | EXPORT_SYMBOL(iwl_tt_handler); | ||
863 | |||
864 | /* Thermal throttling initialization | ||
865 | * For advance thermal throttling: | ||
866 | * Initialize Thermal Index and temperature threshold table | ||
867 | * Initialize thermal throttling restriction table | ||
868 | */ | ||
869 | void iwl_tt_initialize(struct iwl_priv *priv) | ||
870 | { | ||
871 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
872 | int size = sizeof(struct iwl_tt_trans) * (IWL_TI_STATE_MAX - 1); | ||
873 | struct iwl_tt_trans *transaction; | ||
874 | |||
875 | IWL_DEBUG_POWER(priv, "Initialize Thermal Throttling\n"); | ||
876 | |||
877 | memset(tt, 0, sizeof(struct iwl_tt_mgmt)); | ||
878 | |||
879 | tt->state = IWL_TI_0; | ||
880 | init_timer(&priv->thermal_throttle.ct_kill_exit_tm); | ||
881 | priv->thermal_throttle.ct_kill_exit_tm.data = (unsigned long)priv; | ||
882 | priv->thermal_throttle.ct_kill_exit_tm.function = | ||
883 | iwl_tt_check_exit_ct_kill; | ||
884 | init_timer(&priv->thermal_throttle.ct_kill_waiting_tm); | ||
885 | priv->thermal_throttle.ct_kill_waiting_tm.data = (unsigned long)priv; | ||
886 | priv->thermal_throttle.ct_kill_waiting_tm.function = | ||
887 | iwl_tt_ready_for_ct_kill; | ||
888 | /* setup deferred ct kill work */ | ||
889 | INIT_WORK(&priv->tt_work, iwl_bg_tt_work); | ||
890 | INIT_WORK(&priv->ct_enter, iwl_bg_ct_enter); | ||
891 | INIT_WORK(&priv->ct_exit, iwl_bg_ct_exit); | ||
892 | |||
893 | if (priv->cfg->adv_thermal_throttle) { | ||
894 | IWL_DEBUG_POWER(priv, "Advanced Thermal Throttling\n"); | ||
895 | tt->restriction = kzalloc(sizeof(struct iwl_tt_restriction) * | ||
896 | IWL_TI_STATE_MAX, GFP_KERNEL); | ||
897 | tt->transaction = kzalloc(sizeof(struct iwl_tt_trans) * | ||
898 | IWL_TI_STATE_MAX * (IWL_TI_STATE_MAX - 1), | ||
899 | GFP_KERNEL); | ||
900 | if (!tt->restriction || !tt->transaction) { | ||
901 | IWL_ERR(priv, "Fallback to Legacy Throttling\n"); | ||
902 | priv->thermal_throttle.advanced_tt = false; | ||
903 | kfree(tt->restriction); | ||
904 | tt->restriction = NULL; | ||
905 | kfree(tt->transaction); | ||
906 | tt->transaction = NULL; | ||
907 | } else { | ||
908 | transaction = tt->transaction + | ||
909 | (IWL_TI_0 * (IWL_TI_STATE_MAX - 1)); | ||
910 | memcpy(transaction, &tt_range_0[0], size); | ||
911 | transaction = tt->transaction + | ||
912 | (IWL_TI_1 * (IWL_TI_STATE_MAX - 1)); | ||
913 | memcpy(transaction, &tt_range_1[0], size); | ||
914 | transaction = tt->transaction + | ||
915 | (IWL_TI_2 * (IWL_TI_STATE_MAX - 1)); | ||
916 | memcpy(transaction, &tt_range_2[0], size); | ||
917 | transaction = tt->transaction + | ||
918 | (IWL_TI_CT_KILL * (IWL_TI_STATE_MAX - 1)); | ||
919 | memcpy(transaction, &tt_range_3[0], size); | ||
920 | size = sizeof(struct iwl_tt_restriction) * | ||
921 | IWL_TI_STATE_MAX; | ||
922 | memcpy(tt->restriction, | ||
923 | &restriction_range[0], size); | ||
924 | priv->thermal_throttle.advanced_tt = true; | ||
925 | } | ||
926 | } else { | ||
927 | IWL_DEBUG_POWER(priv, "Legacy Thermal Throttling\n"); | ||
928 | priv->thermal_throttle.advanced_tt = false; | ||
929 | } | ||
930 | } | ||
931 | EXPORT_SYMBOL(iwl_tt_initialize); | ||
932 | |||
933 | /* cleanup thermal throttling management related memory and timer */ | ||
934 | void iwl_tt_exit(struct iwl_priv *priv) | ||
935 | { | ||
936 | struct iwl_tt_mgmt *tt = &priv->thermal_throttle; | ||
937 | |||
938 | /* stop ct_kill_exit_tm timer if activated */ | ||
939 | del_timer_sync(&priv->thermal_throttle.ct_kill_exit_tm); | ||
940 | /* stop ct_kill_waiting_tm timer if activated */ | ||
941 | del_timer_sync(&priv->thermal_throttle.ct_kill_waiting_tm); | ||
942 | cancel_work_sync(&priv->tt_work); | ||
943 | cancel_work_sync(&priv->ct_enter); | ||
944 | cancel_work_sync(&priv->ct_exit); | ||
945 | |||
946 | if (priv->thermal_throttle.advanced_tt) { | ||
947 | /* free advance thermal throttling memory */ | ||
948 | kfree(tt->restriction); | ||
949 | tt->restriction = NULL; | ||
950 | kfree(tt->transaction); | ||
951 | tt->transaction = NULL; | ||
952 | } | ||
953 | } | ||
954 | EXPORT_SYMBOL(iwl_tt_exit); | ||
955 | |||
956 | /* initialize to default */ | 332 | /* initialize to default */ |
957 | void iwl_power_initialize(struct iwl_priv *priv) | 333 | void iwl_power_initialize(struct iwl_priv *priv) |
958 | { | 334 | { |