pm.c 2.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124
  1. #include <net/mac80211.h>
  2. #include <net/rtnetlink.h>
  3. #include "ieee80211_i.h"
  4. #include "mesh.h"
  5. #include "driver-ops.h"
  6. #include "led.h"
  7. int __ieee80211_suspend(struct ieee80211_hw *hw)
  8. {
  9. struct ieee80211_local *local = hw_to_local(hw);
  10. struct ieee80211_sub_if_data *sdata;
  11. struct ieee80211_if_init_conf conf;
  12. struct sta_info *sta;
  13. unsigned long flags;
  14. ieee80211_scan_cancel(local);
  15. ieee80211_stop_queues_by_reason(hw,
  16. IEEE80211_QUEUE_STOP_REASON_SUSPEND);
  17. /* flush out all packets */
  18. synchronize_net();
  19. local->quiescing = true;
  20. /* make quiescing visible to timers everywhere */
  21. mb();
  22. flush_workqueue(local->hw.workqueue);
  23. /* Don't try to run timers while suspended. */
  24. del_timer_sync(&local->sta_cleanup);
  25. /*
  26. * Note that this particular timer doesn't need to be
  27. * restarted at resume.
  28. */
  29. cancel_work_sync(&local->dynamic_ps_enable_work);
  30. del_timer_sync(&local->dynamic_ps_timer);
  31. /* disable keys */
  32. list_for_each_entry(sdata, &local->interfaces, list)
  33. ieee80211_disable_keys(sdata);
  34. /* Tear down aggregation sessions */
  35. rcu_read_lock();
  36. if (hw->flags & IEEE80211_HW_AMPDU_AGGREGATION) {
  37. list_for_each_entry_rcu(sta, &local->sta_list, list) {
  38. set_sta_flags(sta, WLAN_STA_SUSPEND);
  39. ieee80211_sta_tear_down_BA_sessions(sta);
  40. }
  41. }
  42. rcu_read_unlock();
  43. /* flush again, in case driver queued work */
  44. flush_workqueue(local->hw.workqueue);
  45. /* stop hardware - this must stop RX */
  46. if (local->open_count) {
  47. ieee80211_led_radio(local, false);
  48. drv_stop(local);
  49. }
  50. /* remove STAs */
  51. spin_lock_irqsave(&local->sta_lock, flags);
  52. list_for_each_entry(sta, &local->sta_list, list) {
  53. if (local->ops->sta_notify) {
  54. sdata = sta->sdata;
  55. if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
  56. sdata = container_of(sdata->bss,
  57. struct ieee80211_sub_if_data,
  58. u.ap);
  59. drv_sta_notify(local, &sdata->vif, STA_NOTIFY_REMOVE,
  60. &sta->sta);
  61. }
  62. mesh_plink_quiesce(sta);
  63. }
  64. spin_unlock_irqrestore(&local->sta_lock, flags);
  65. /* remove all interfaces */
  66. list_for_each_entry(sdata, &local->interfaces, list) {
  67. switch(sdata->vif.type) {
  68. case NL80211_IFTYPE_STATION:
  69. ieee80211_sta_quiesce(sdata);
  70. break;
  71. case NL80211_IFTYPE_ADHOC:
  72. ieee80211_ibss_quiesce(sdata);
  73. break;
  74. case NL80211_IFTYPE_MESH_POINT:
  75. ieee80211_mesh_quiesce(sdata);
  76. break;
  77. case NL80211_IFTYPE_AP_VLAN:
  78. case NL80211_IFTYPE_MONITOR:
  79. /* don't tell driver about this */
  80. continue;
  81. default:
  82. break;
  83. }
  84. if (!netif_running(sdata->dev))
  85. continue;
  86. conf.vif = &sdata->vif;
  87. conf.type = sdata->vif.type;
  88. conf.mac_addr = sdata->dev->dev_addr;
  89. drv_remove_interface(local, &conf);
  90. }
  91. local->suspended = true;
  92. local->quiescing = false;
  93. return 0;
  94. }
  95. /*
  96. * __ieee80211_resume() is a static inline which just calls
  97. * ieee80211_reconfig(), which is also needed for hardware
  98. * hang/firmware failure/etc. recovery.
  99. */