[mirror_ubuntu-zesty-kernel.git] / net / mac80211 / pm.c

#include <net/mac80211.h>
#include <net/rtnetlink.h>

#include "ieee80211_i.h"
#include "mesh.h"
#include "driver-ops.h"
#include "led.h"

/* return value indicates whether the driver should be further notified */
static bool ieee80211_quiesce(struct ieee80211_sub_if_data *sdata)
{
	switch (sdata->vif.type) {
	case NL80211_IFTYPE_STATION:
		ieee80211_sta_quiesce(sdata);
		return true;
	case NL80211_IFTYPE_ADHOC:
		ieee80211_ibss_quiesce(sdata);
		return true;
	case NL80211_IFTYPE_MESH_POINT:
		ieee80211_mesh_quiesce(sdata);
		return true;
	case NL80211_IFTYPE_AP_VLAN:
	case NL80211_IFTYPE_MONITOR:
		/* don't tell driver about this */
		return false;
	default:
		return true;
	}
}

int __ieee80211_suspend(struct ieee80211_hw *hw, struct cfg80211_wowlan *wowlan)
{
	struct ieee80211_local *local = hw_to_local(hw);
	struct ieee80211_sub_if_data *sdata;
	struct sta_info *sta;
	struct ieee80211_chanctx *ctx;

	if (!local->open_count)
		goto suspend;

	ieee80211_scan_cancel(local);

	if (hw->flags & IEEE80211_HW_AMPDU_AGGREGATION) {
		mutex_lock(&local->sta_mtx);
		list_for_each_entry(sta, &local->sta_list, list) {
			set_sta_flag(sta, WLAN_STA_BLOCK_BA);
			ieee80211_sta_tear_down_BA_sessions(sta, true);
		}
		mutex_unlock(&local->sta_mtx);
	}

	ieee80211_stop_queues_by_reason(hw,
			IEEE80211_QUEUE_STOP_REASON_SUSPEND);

	/* flush out all packets */
	synchronize_net();

	drv_flush(local, false);

	local->quiescing = true;
	/* make quiescing visible to timers everywhere */
	mb();

	flush_workqueue(local->workqueue);

	/* Don't try to run timers while suspended. */
	del_timer_sync(&local->sta_cleanup);

	 /*
	 * Note that this particular timer doesn't need to be
	 * restarted at resume.
	 */
	cancel_work_sync(&local->dynamic_ps_enable_work);
	del_timer_sync(&local->dynamic_ps_timer);

	local->wowlan = wowlan && local->open_count;
	if (local->wowlan) {
		int err = drv_suspend(local, wowlan);
		if (err < 0) {
			local->quiescing = false;
			local->wowlan = false;
			if (hw->flags & IEEE80211_HW_AMPDU_AGGREGATION) {
				mutex_lock(&local->sta_mtx);
				list_for_each_entry(sta,
						    &local->sta_list, list) {
					clear_sta_flag(sta, WLAN_STA_BLOCK_BA);
				}
				mutex_unlock(&local->sta_mtx);
			}
			ieee80211_wake_queues_by_reason(hw,
					IEEE80211_QUEUE_STOP_REASON_SUSPEND);
			return err;
		} else if (err > 0) {
			WARN_ON(err != 1);
			local->wowlan = false;
		} else {
			list_for_each_entry(sdata, &local->interfaces, list) {
				cancel_work_sync(&sdata->work);
				ieee80211_quiesce(sdata);
			}
			goto suspend;
		}
	}

	/* disable keys */
	list_for_each_entry(sdata, &local->interfaces, list)
		ieee80211_disable_keys(sdata);

	/* tear down aggregation sessions and remove STAs */
	mutex_lock(&local->sta_mtx);
	list_for_each_entry(sta, &local->sta_list, list) {
		if (sta->uploaded) {
			enum ieee80211_sta_state state;

			state = sta->sta_state;
			for (; state > IEEE80211_STA_NOTEXIST; state--)
				WARN_ON(drv_sta_state(local, sta->sdata, sta,
						      state, state - 1));
		}

		mesh_plink_quiesce(sta);
	}
	mutex_unlock(&local->sta_mtx);

	/* remove all interfaces */
	list_for_each_entry(sdata, &local->interfaces, list) {
		cancel_work_sync(&sdata->work);

		if (!ieee80211_quiesce(sdata))
			continue;

		if (!ieee80211_sdata_running(sdata))
			continue;

		/* disable beaconing */
		ieee80211_bss_info_change_notify(sdata,
			BSS_CHANGED_BEACON_ENABLED);

		if (sdata->vif.type == NL80211_IFTYPE_AP &&
		    rcu_access_pointer(sdata->u.ap.beacon))
			drv_stop_ap(local, sdata);

		if (local->use_chanctx) {
			struct ieee80211_chanctx_conf *conf;

			mutex_lock(&local->chanctx_mtx);
			conf = rcu_dereference_protected(
					sdata->vif.chanctx_conf,
					lockdep_is_held(&local->chanctx_mtx));
			if (conf) {
				ctx = container_of(conf,
						   struct ieee80211_chanctx,
						   conf);
				drv_unassign_vif_chanctx(local, sdata, ctx);
			}

			mutex_unlock(&local->chanctx_mtx);
		}
		drv_remove_interface(local, sdata);
	}

	sdata = rtnl_dereference(local->monitor_sdata);
	if (sdata) {
		if (local->use_chanctx) {
			struct ieee80211_chanctx_conf *conf;

			mutex_lock(&local->chanctx_mtx);
			conf = rcu_dereference_protected(
					sdata->vif.chanctx_conf,
					lockdep_is_held(&local->chanctx_mtx));
			if (conf) {
				ctx = container_of(conf,
						   struct ieee80211_chanctx,
						   conf);
				drv_unassign_vif_chanctx(local, sdata, ctx);
			}

			mutex_unlock(&local->chanctx_mtx);
		}

		drv_remove_interface(local, sdata);
	}

	mutex_lock(&local->chanctx_mtx);
	list_for_each_entry(ctx, &local->chanctx_list, list)
		drv_remove_chanctx(local, ctx);
	mutex_unlock(&local->chanctx_mtx);

	/* stop hardware - this must stop RX */
	if (local->open_count)
		ieee80211_stop_device(local);

 suspend:
	local->suspended = true;
	/* need suspended to be visible before quiescing is false */
	barrier();
	local->quiescing = false;

	return 0;
}

/*
 * __ieee80211_resume() is a static inline which just calls
 * ieee80211_reconfig(), which is also needed for hardware
 * hang/firmware failure/etc. recovery.
 */
Commit	Line	Data
665af4fc BC	1	#include <net/mac80211.h>
	2	#include <net/rtnetlink.h>
	3
	4	#include "ieee80211_i.h"
5bb644a0	5	#include "mesh.h"
24487981	6	#include "driver-ops.h"
665af4fc BC	7	#include "led.h"
665af4fc BC	8
77572fd1 EP	9	/* return value indicates whether the driver should be further notified */
	10	static bool ieee80211_quiesce(struct ieee80211_sub_if_data *sdata)
	11	{
	12	switch (sdata->vif.type) {
	13	case NL80211_IFTYPE_STATION:
	14	ieee80211_sta_quiesce(sdata);
	15	return true;
	16	case NL80211_IFTYPE_ADHOC:
	17	ieee80211_ibss_quiesce(sdata);
	18	return true;
	19	case NL80211_IFTYPE_MESH_POINT:
	20	ieee80211_mesh_quiesce(sdata);
	21	return true;
	22	case NL80211_IFTYPE_AP_VLAN:
	23	case NL80211_IFTYPE_MONITOR:
	24	/* don't tell driver about this */
	25	return false;
	26	default:
	27	return true;
	28	}
	29	}
	30
eecc4800	31	int __ieee80211_suspend(struct ieee80211_hw hw, struct cfg80211_wowlan wowlan)
665af4fc BC	32	{
	33	struct ieee80211_local *local = hw_to_local(hw);
	34	struct ieee80211_sub_if_data *sdata;
665af4fc	35	struct sta_info *sta;
fe5f2559	36	struct ieee80211_chanctx *ctx;
665af4fc	37
94f9b97b JB	38	if (!local->open_count)
	39	goto suspend;
	40
4136c422	41	ieee80211_scan_cancel(local);
5bb644a0	42
ca45de77 JB	43	if (hw->flags & IEEE80211_HW_AMPDU_AGGREGATION) {
	44	mutex_lock(&local->sta_mtx);
	45	list_for_each_entry(sta, &local->sta_list, list) {
c2c98fde	46	set_sta_flag(sta, WLAN_STA_BLOCK_BA);
ca45de77 JB	47	ieee80211_sta_tear_down_BA_sessions(sta, true);
	48	}
	49	mutex_unlock(&local->sta_mtx);
	50	}
	51
25420604 JB	52	ieee80211_stop_queues_by_reason(hw,
	53	IEEE80211_QUEUE_STOP_REASON_SUSPEND);
	54
5bb644a0 JB	55	/* flush out all packets */
	56	synchronize_net();
	57
ca45de77 JB	58	drv_flush(local, false);
ca45de77 JB	59
5bb644a0 JB	60	local->quiescing = true;
	61	/* make quiescing visible to timers everywhere */
	62	mb();
	63
42935eca	64	flush_workqueue(local->workqueue);
665af4fc	65
5bb644a0 JB	66	/* Don't try to run timers while suspended. */
	67	del_timer_sync(&local->sta_cleanup);
	68
	69	/*
	70	* Note that this particular timer doesn't need to be
	71	* restarted at resume.
	72	*/
	73	cancel_work_sync(&local->dynamic_ps_enable_work);
	74	del_timer_sync(&local->dynamic_ps_timer);
	75
eecc4800 JB	76	local->wowlan = wowlan && local->open_count;
	77	if (local->wowlan) {
	78	int err = drv_suspend(local, wowlan);
2b4562df	79	if (err < 0) {
eecc4800	80	local->quiescing = false;
3b08cf6b	81	local->wowlan = false;
9ea4fa15 ES	82	if (hw->flags & IEEE80211_HW_AMPDU_AGGREGATION) {
	83	mutex_lock(&local->sta_mtx);
	84	list_for_each_entry(sta,
	85	&local->sta_list, list) {
	86	clear_sta_flag(sta, WLAN_STA_BLOCK_BA);
	87	}
	88	mutex_unlock(&local->sta_mtx);
	89	}
	90	ieee80211_wake_queues_by_reason(hw,
	91	IEEE80211_QUEUE_STOP_REASON_SUSPEND);
eecc4800	92	return err;
2b4562df JB	93	} else if (err > 0) {
	94	WARN_ON(err != 1);
	95	local->wowlan = false;
	96	} else {
	97	list_for_each_entry(sdata, &local->interfaces, list) {
	98	cancel_work_sync(&sdata->work);
	99	ieee80211_quiesce(sdata);
	100	}
	101	goto suspend;
eecc4800	102	}
eecc4800 JB	103	}
eecc4800 JB	104
665af4fc BC	105	/* disable keys */
	106	list_for_each_entry(sdata, &local->interfaces, list)
	107	ieee80211_disable_keys(sdata);
	108
2a419056 JB	109	/* tear down aggregation sessions and remove STAs */
	110	mutex_lock(&local->sta_mtx);
	111	list_for_each_entry(sta, &local->sta_list, list) {
f09603a2 JB	112	if (sta->uploaded) {
	113	enum ieee80211_sta_state state;
	114
f09603a2 JB	115	state = sta->sta_state;
f09603a2 JB	116	for (; state > IEEE80211_STA_NOTEXIST; state--)
9d88c7f6	117	WARN_ON(drv_sta_state(local, sta->sdata, sta,
f09603a2 JB	118	state, state - 1));
	119	}
	120
5bb644a0	121	mesh_plink_quiesce(sta);
665af4fc	122	}
34e89507	123	mutex_unlock(&local->sta_mtx);
665af4fc BC	124
	125	/* remove all interfaces */
	126	list_for_each_entry(sdata, &local->interfaces, list) {
64592c8f JB	127	cancel_work_sync(&sdata->work);
64592c8f JB	128
77572fd1	129	if (!ieee80211_quiesce(sdata))
5bb644a0	130	continue;
665af4fc	131
9607e6b6	132	if (!ieee80211_sdata_running(sdata))
5bb644a0	133	continue;
e874e658	134
97af7432 BC	135	/* disable beaconing */
	136	ieee80211_bss_info_change_notify(sdata,
	137	BSS_CHANGED_BEACON_ENABLED);
	138
1041638f JB	139	if (sdata->vif.type == NL80211_IFTYPE_AP &&
	140	rcu_access_pointer(sdata->u.ap.beacon))
	141	drv_stop_ap(local, sdata);
	142
fe5f2559 JB	143	if (local->use_chanctx) {
	144	struct ieee80211_chanctx_conf *conf;
	145
	146	mutex_lock(&local->chanctx_mtx);
	147	conf = rcu_dereference_protected(
	148	sdata->vif.chanctx_conf,
	149	lockdep_is_held(&local->chanctx_mtx));
	150	if (conf) {
	151	ctx = container_of(conf,
	152	struct ieee80211_chanctx,
	153	conf);
	154	drv_unassign_vif_chanctx(local, sdata, ctx);
	155	}
	156
	157	mutex_unlock(&local->chanctx_mtx);
	158	}
7b7eab6f	159	drv_remove_interface(local, sdata);
665af4fc	160	}
5bb644a0	161
4b6f1dd6	162	sdata = rtnl_dereference(local->monitor_sdata);
fe5f2559 JB	163	if (sdata) {
	164	if (local->use_chanctx) {
	165	struct ieee80211_chanctx_conf *conf;
	166
	167	mutex_lock(&local->chanctx_mtx);
	168	conf = rcu_dereference_protected(
	169	sdata->vif.chanctx_conf,
	170	lockdep_is_held(&local->chanctx_mtx));
	171	if (conf) {
	172	ctx = container_of(conf,
	173	struct ieee80211_chanctx,
	174	conf);
	175	drv_unassign_vif_chanctx(local, sdata, ctx);
	176	}
	177
	178	mutex_unlock(&local->chanctx_mtx);
	179	}
	180
4b6f1dd6	181	drv_remove_interface(local, sdata);
fe5f2559 JB	182	}
	183
	184	mutex_lock(&local->chanctx_mtx);
	185	list_for_each_entry(ctx, &local->chanctx_list, list)
	186	drv_remove_chanctx(local, ctx);
	187	mutex_unlock(&local->chanctx_mtx);
4b6f1dd6	188
89c3a8ac	189	/* stop hardware - this must stop RX */
84f6a01c JB	190	if (local->open_count)
84f6a01c JB	191	ieee80211_stop_device(local);
89c3a8ac	192
eecc4800	193	suspend:
5bb644a0	194	local->suspended = true;
89c3a8ac JB	195	/* need suspended to be visible before quiescing is false */
89c3a8ac JB	196	barrier();
5bb644a0 JB	197	local->quiescing = false;
5bb644a0 JB	198
665af4fc BC	199	return 0;
	200	}
	201
f2753ddb JB	202	/*
	203	* __ieee80211_resume() is a static inline which just calls
	204	* ieee80211_reconfig(), which is also needed for hardware
	205	* hang/firmware failure/etc. recovery.
	206	*/