[GitHub/mt8127/android_kernel_alcatel_ttab.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 void ieee80211_quiesce(struct ieee80211_sub_if_data *sdata)
{
	switch (sdata->vif.type) {
	case NL80211_IFTYPE_STATION:
		ieee80211_sta_quiesce(sdata);
		break;
	case NL80211_IFTYPE_ADHOC:
		ieee80211_ibss_quiesce(sdata);
		break;
	case NL80211_IFTYPE_MESH_POINT:
		ieee80211_mesh_quiesce(sdata);
		break;
	default:
		break;
	}

	cancel_work_sync(&sdata->work);
}

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);

	ieee80211_dfs_cac_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, AGG_STOP_LOCAL_REQUEST);
		}
		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)
				if (ieee80211_sdata_running(sdata))
					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) {
		static u8 zero_addr[ETH_ALEN] = {};
		u32 changed = 0;

		if (!ieee80211_sdata_running(sdata))
			continue;

		switch (sdata->vif.type) {
		case NL80211_IFTYPE_AP_VLAN:
		case NL80211_IFTYPE_MONITOR:
			/* skip these */
			continue;
		case NL80211_IFTYPE_STATION:
			if (sdata->vif.bss_conf.assoc)
				changed = BSS_CHANGED_ASSOC |
					  BSS_CHANGED_BSSID |
					  BSS_CHANGED_IDLE;
			break;
		case NL80211_IFTYPE_AP:
		case NL80211_IFTYPE_ADHOC:
		case NL80211_IFTYPE_MESH_POINT:
			if (sdata->vif.bss_conf.enable_beacon)
				changed = BSS_CHANGED_BEACON_ENABLED;
			break;
		default:
			break;
		}

		ieee80211_quiesce(sdata);

		sdata->suspend_bss_conf = sdata->vif.bss_conf;
		memset(&sdata->vif.bss_conf, 0, sizeof(sdata->vif.bss_conf));
		sdata->vif.bss_conf.idle = true;
		if (sdata->suspend_bss_conf.bssid)
			sdata->vif.bss_conf.bssid = zero_addr;

		/* disable beaconing or remove association */
		ieee80211_bss_info_change_notify(sdata, changed);

		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.
 */

void ieee80211_report_wowlan_wakeup(struct ieee80211_vif *vif,
				    struct cfg80211_wowlan_wakeup *wakeup,
				    gfp_t gfp)
{
	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);

	cfg80211_report_wowlan_wakeup(&sdata->wdev, wakeup, gfp);
}
EXPORT_SYMBOL(ieee80211_report_wowlan_wakeup);
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	9	/* return value indicates whether the driver should be further notified */
61e8a48c	10	static void ieee80211_quiesce(struct ieee80211_sub_if_data *sdata)
77572fd1 EP	11	{
	12	switch (sdata->vif.type) {
	13	case NL80211_IFTYPE_STATION:
	14	ieee80211_sta_quiesce(sdata);
61e8a48c	15	break;
77572fd1 EP	16	case NL80211_IFTYPE_ADHOC:
77572fd1 EP	17	ieee80211_ibss_quiesce(sdata);
61e8a48c	18	break;
77572fd1 EP	19	case NL80211_IFTYPE_MESH_POINT:
77572fd1 EP	20	ieee80211_mesh_quiesce(sdata);
61e8a48c	21	break;
77572fd1	22	default:
61e8a48c	23	break;
77572fd1	24	}
61e8a48c JB	25
61e8a48c JB	26	cancel_work_sync(&sdata->work);
77572fd1 EP	27	}
77572fd1 EP	28
eecc4800	29	int __ieee80211_suspend(struct ieee80211_hw hw, struct cfg80211_wowlan wowlan)
665af4fc BC	30	{
	31	struct ieee80211_local *local = hw_to_local(hw);
	32	struct ieee80211_sub_if_data *sdata;
665af4fc	33	struct sta_info *sta;
fe5f2559	34	struct ieee80211_chanctx *ctx;
665af4fc	35
94f9b97b JB	36	if (!local->open_count)
	37	goto suspend;
	38
4136c422	39	ieee80211_scan_cancel(local);
5bb644a0	40
164eb02d SW	41	ieee80211_dfs_cac_cancel(local);
164eb02d SW	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);
c82c4a80 JB	47	ieee80211_sta_tear_down_BA_sessions(
c82c4a80 JB	48	sta, AGG_STOP_LOCAL_REQUEST);
ca45de77 JB	49	}
	50	mutex_unlock(&local->sta_mtx);
	51	}
	52
25420604 JB	53	ieee80211_stop_queues_by_reason(hw,
	54	IEEE80211_QUEUE_STOP_REASON_SUSPEND);
	55
5bb644a0 JB	56	/* flush out all packets */
	57	synchronize_net();
	58
ca45de77 JB	59	drv_flush(local, false);
ca45de77 JB	60
5bb644a0 JB	61	local->quiescing = true;
	62	/* make quiescing visible to timers everywhere */
	63	mb();
	64
42935eca	65	flush_workqueue(local->workqueue);
665af4fc	66
5bb644a0 JB	67	/* Don't try to run timers while suspended. */
	68	del_timer_sync(&local->sta_cleanup);
	69
	70	/*
	71	* Note that this particular timer doesn't need to be
	72	* restarted at resume.
	73	*/
	74	cancel_work_sync(&local->dynamic_ps_enable_work);
	75	del_timer_sync(&local->dynamic_ps_timer);
	76
eecc4800 JB	77	local->wowlan = wowlan && local->open_count;
	78	if (local->wowlan) {
	79	int err = drv_suspend(local, wowlan);
2b4562df	80	if (err < 0) {
eecc4800	81	local->quiescing = false;
3b08cf6b	82	local->wowlan = false;
9ea4fa15 ES	83	if (hw->flags & IEEE80211_HW_AMPDU_AGGREGATION) {
	84	mutex_lock(&local->sta_mtx);
	85	list_for_each_entry(sta,
	86	&local->sta_list, list) {
	87	clear_sta_flag(sta, WLAN_STA_BLOCK_BA);
	88	}
	89	mutex_unlock(&local->sta_mtx);
	90	}
	91	ieee80211_wake_queues_by_reason(hw,
	92	IEEE80211_QUEUE_STOP_REASON_SUSPEND);
eecc4800	93	return err;
2b4562df JB	94	} else if (err > 0) {
	95	WARN_ON(err != 1);
	96	local->wowlan = false;
	97	} else {
61e8a48c JB	98	list_for_each_entry(sdata, &local->interfaces, list)
	99	if (ieee80211_sdata_running(sdata))
	100	ieee80211_quiesce(sdata);
2b4562df	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) {
ad2d223a	127	static u8 zero_addr[ETH_ALEN] = {};
b8dc1a35	128	u32 changed = 0;
529ba6e9	129
61e8a48c	130	if (!ieee80211_sdata_running(sdata))
5bb644a0	131	continue;
665af4fc	132
61e8a48c JB	133	switch (sdata->vif.type) {
	134	case NL80211_IFTYPE_AP_VLAN:
	135	case NL80211_IFTYPE_MONITOR:
	136	/* skip these */
5bb644a0	137	continue;
529ba6e9 JB	138	case NL80211_IFTYPE_STATION:
	139	if (sdata->vif.bss_conf.assoc)
	140	changed = BSS_CHANGED_ASSOC \|
	141	BSS_CHANGED_BSSID \|
	142	BSS_CHANGED_IDLE;
b8dc1a35 JB	143	break;
	144	case NL80211_IFTYPE_AP:
	145	case NL80211_IFTYPE_ADHOC:
	146	case NL80211_IFTYPE_MESH_POINT:
	147	if (sdata->vif.bss_conf.enable_beacon)
	148	changed = BSS_CHANGED_BEACON_ENABLED;
	149	break;
61e8a48c	150	default:
61e8a48c JB	151	break;
61e8a48c JB	152	}
e874e658	153
b8dc1a35 JB	154	ieee80211_quiesce(sdata);
b8dc1a35 JB	155
529ba6e9 JB	156	sdata->suspend_bss_conf = sdata->vif.bss_conf;
	157	memset(&sdata->vif.bss_conf, 0, sizeof(sdata->vif.bss_conf));
	158	sdata->vif.bss_conf.idle = true;
ad2d223a JB	159	if (sdata->suspend_bss_conf.bssid)
ad2d223a JB	160	sdata->vif.bss_conf.bssid = zero_addr;
529ba6e9 JB	161
	162	/* disable beaconing or remove association */
	163	ieee80211_bss_info_change_notify(sdata, changed);
97af7432	164
1041638f JB	165	if (sdata->vif.type == NL80211_IFTYPE_AP &&
	166	rcu_access_pointer(sdata->u.ap.beacon))
	167	drv_stop_ap(local, sdata);
	168
fe5f2559 JB	169	if (local->use_chanctx) {
	170	struct ieee80211_chanctx_conf *conf;
	171
	172	mutex_lock(&local->chanctx_mtx);
	173	conf = rcu_dereference_protected(
	174	sdata->vif.chanctx_conf,
	175	lockdep_is_held(&local->chanctx_mtx));
	176	if (conf) {
	177	ctx = container_of(conf,
	178	struct ieee80211_chanctx,
	179	conf);
	180	drv_unassign_vif_chanctx(local, sdata, ctx);
	181	}
	182
	183	mutex_unlock(&local->chanctx_mtx);
	184	}
7b7eab6f	185	drv_remove_interface(local, sdata);
665af4fc	186	}
5bb644a0	187
4b6f1dd6	188	sdata = rtnl_dereference(local->monitor_sdata);
fe5f2559 JB	189	if (sdata) {
	190	if (local->use_chanctx) {
	191	struct ieee80211_chanctx_conf *conf;
	192
	193	mutex_lock(&local->chanctx_mtx);
	194	conf = rcu_dereference_protected(
	195	sdata->vif.chanctx_conf,
	196	lockdep_is_held(&local->chanctx_mtx));
	197	if (conf) {
	198	ctx = container_of(conf,
	199	struct ieee80211_chanctx,
	200	conf);
	201	drv_unassign_vif_chanctx(local, sdata, ctx);
	202	}
	203
	204	mutex_unlock(&local->chanctx_mtx);
	205	}
	206
4b6f1dd6	207	drv_remove_interface(local, sdata);
fe5f2559 JB	208	}
	209
	210	mutex_lock(&local->chanctx_mtx);
	211	list_for_each_entry(ctx, &local->chanctx_list, list)
	212	drv_remove_chanctx(local, ctx);
	213	mutex_unlock(&local->chanctx_mtx);
4b6f1dd6	214
89c3a8ac	215	/* stop hardware - this must stop RX */
84f6a01c JB	216	if (local->open_count)
84f6a01c JB	217	ieee80211_stop_device(local);
89c3a8ac	218
eecc4800	219	suspend:
5bb644a0	220	local->suspended = true;
89c3a8ac JB	221	/* need suspended to be visible before quiescing is false */
89c3a8ac JB	222	barrier();
5bb644a0 JB	223	local->quiescing = false;
5bb644a0 JB	224
665af4fc BC	225	return 0;
	226	}
	227
f2753ddb JB	228	/*
	229	* __ieee80211_resume() is a static inline which just calls
	230	* ieee80211_reconfig(), which is also needed for hardware
	231	* hang/firmware failure/etc. recovery.
	232	*/
cd8f7cb4 JB	233
	234	void ieee80211_report_wowlan_wakeup(struct ieee80211_vif *vif,
	235	struct cfg80211_wowlan_wakeup *wakeup,
	236	gfp_t gfp)
	237	{
	238	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
	239
	240	cfg80211_report_wowlan_wakeup(&sdata->wdev, wakeup, gfp);
	241	}
	242	EXPORT_SYMBOL(ieee80211_report_wowlan_wakeup);