[mirror_ubuntu-bionic-kernel.git] / net / mac80211 / led.c

/*
 * Copyright 2006, Johannes Berg <johannes@sipsolutions.net>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

/* just for IFNAMSIZ */
#include <linux/if.h>
#include <linux/slab.h>
#include <linux/export.h>
#include "led.h"

void ieee80211_led_assoc(struct ieee80211_local *local, bool associated)
{
	if (!atomic_read(&local->assoc_led_active))
		return;
	if (associated)
		led_trigger_event(&local->assoc_led, LED_FULL);
	else
		led_trigger_event(&local->assoc_led, LED_OFF);
}

void ieee80211_led_radio(struct ieee80211_local *local, bool enabled)
{
	if (!atomic_read(&local->radio_led_active))
		return;
	if (enabled)
		led_trigger_event(&local->radio_led, LED_FULL);
	else
		led_trigger_event(&local->radio_led, LED_OFF);
}

void ieee80211_alloc_led_names(struct ieee80211_local *local)
{
	local->rx_led.name = kasprintf(GFP_KERNEL, "%srx",
				       wiphy_name(local->hw.wiphy));
	local->tx_led.name = kasprintf(GFP_KERNEL, "%stx",
				       wiphy_name(local->hw.wiphy));
	local->assoc_led.name = kasprintf(GFP_KERNEL, "%sassoc",
					  wiphy_name(local->hw.wiphy));
	local->radio_led.name = kasprintf(GFP_KERNEL, "%sradio",
					  wiphy_name(local->hw.wiphy));
}

void ieee80211_free_led_names(struct ieee80211_local *local)
{
	kfree(local->rx_led.name);
	kfree(local->tx_led.name);
	kfree(local->assoc_led.name);
	kfree(local->radio_led.name);
}

static void ieee80211_tx_led_activate(struct led_classdev *led_cdev)
{
	struct ieee80211_local *local = container_of(led_cdev->trigger,
						     struct ieee80211_local,
						     tx_led);

	atomic_inc(&local->tx_led_active);
}

static void ieee80211_tx_led_deactivate(struct led_classdev *led_cdev)
{
	struct ieee80211_local *local = container_of(led_cdev->trigger,
						     struct ieee80211_local,
						     tx_led);

	atomic_dec(&local->tx_led_active);
}

static void ieee80211_rx_led_activate(struct led_classdev *led_cdev)
{
	struct ieee80211_local *local = container_of(led_cdev->trigger,
						     struct ieee80211_local,
						     rx_led);

	atomic_inc(&local->rx_led_active);
}

static void ieee80211_rx_led_deactivate(struct led_classdev *led_cdev)
{
	struct ieee80211_local *local = container_of(led_cdev->trigger,
						     struct ieee80211_local,
						     rx_led);

	atomic_dec(&local->rx_led_active);
}

static void ieee80211_assoc_led_activate(struct led_classdev *led_cdev)
{
	struct ieee80211_local *local = container_of(led_cdev->trigger,
						     struct ieee80211_local,
						     assoc_led);

	atomic_inc(&local->assoc_led_active);
}

static void ieee80211_assoc_led_deactivate(struct led_classdev *led_cdev)
{
	struct ieee80211_local *local = container_of(led_cdev->trigger,
						     struct ieee80211_local,
						     assoc_led);

	atomic_dec(&local->assoc_led_active);
}

static void ieee80211_radio_led_activate(struct led_classdev *led_cdev)
{
	struct ieee80211_local *local = container_of(led_cdev->trigger,
						     struct ieee80211_local,
						     radio_led);

	atomic_inc(&local->radio_led_active);
}

static void ieee80211_radio_led_deactivate(struct led_classdev *led_cdev)
{
	struct ieee80211_local *local = container_of(led_cdev->trigger,
						     struct ieee80211_local,
						     radio_led);

	atomic_dec(&local->radio_led_active);
}

static void ieee80211_tpt_led_activate(struct led_classdev *led_cdev)
{
	struct ieee80211_local *local = container_of(led_cdev->trigger,
						     struct ieee80211_local,
						     tpt_led);

	atomic_inc(&local->tpt_led_active);
}

static void ieee80211_tpt_led_deactivate(struct led_classdev *led_cdev)
{
	struct ieee80211_local *local = container_of(led_cdev->trigger,
						     struct ieee80211_local,
						     tpt_led);

	atomic_dec(&local->tpt_led_active);
}

void ieee80211_led_init(struct ieee80211_local *local)
{
	atomic_set(&local->rx_led_active, 0);
	local->rx_led.activate = ieee80211_rx_led_activate;
	local->rx_led.deactivate = ieee80211_rx_led_deactivate;
	if (local->rx_led.name && led_trigger_register(&local->rx_led)) {
		kfree(local->rx_led.name);
		local->rx_led.name = NULL;
	}

	atomic_set(&local->tx_led_active, 0);
	local->tx_led.activate = ieee80211_tx_led_activate;
	local->tx_led.deactivate = ieee80211_tx_led_deactivate;
	if (local->tx_led.name && led_trigger_register(&local->tx_led)) {
		kfree(local->tx_led.name);
		local->tx_led.name = NULL;
	}

	atomic_set(&local->assoc_led_active, 0);
	local->assoc_led.activate = ieee80211_assoc_led_activate;
	local->assoc_led.deactivate = ieee80211_assoc_led_deactivate;
	if (local->assoc_led.name && led_trigger_register(&local->assoc_led)) {
		kfree(local->assoc_led.name);
		local->assoc_led.name = NULL;
	}

	atomic_set(&local->radio_led_active, 0);
	local->radio_led.activate = ieee80211_radio_led_activate;
	local->radio_led.deactivate = ieee80211_radio_led_deactivate;
	if (local->radio_led.name && led_trigger_register(&local->radio_led)) {
		kfree(local->radio_led.name);
		local->radio_led.name = NULL;
	}

	atomic_set(&local->tpt_led_active, 0);
	if (local->tpt_led_trigger) {
		local->tpt_led.activate = ieee80211_tpt_led_activate;
		local->tpt_led.deactivate = ieee80211_tpt_led_deactivate;
		if (led_trigger_register(&local->tpt_led)) {
			kfree(local->tpt_led_trigger);
			local->tpt_led_trigger = NULL;
		}
	}
}

void ieee80211_led_exit(struct ieee80211_local *local)
{
	if (local->radio_led.name)
		led_trigger_unregister(&local->radio_led);
	if (local->assoc_led.name)
		led_trigger_unregister(&local->assoc_led);
	if (local->tx_led.name)
		led_trigger_unregister(&local->tx_led);
	if (local->rx_led.name)
		led_trigger_unregister(&local->rx_led);

	if (local->tpt_led_trigger) {
		led_trigger_unregister(&local->tpt_led);
		kfree(local->tpt_led_trigger);
	}
}

const char *__ieee80211_get_radio_led_name(struct ieee80211_hw *hw)
{
	struct ieee80211_local *local = hw_to_local(hw);

	return local->radio_led.name;
}
EXPORT_SYMBOL(__ieee80211_get_radio_led_name);

const char *__ieee80211_get_assoc_led_name(struct ieee80211_hw *hw)
{
	struct ieee80211_local *local = hw_to_local(hw);

	return local->assoc_led.name;
}
EXPORT_SYMBOL(__ieee80211_get_assoc_led_name);

const char *__ieee80211_get_tx_led_name(struct ieee80211_hw *hw)
{
	struct ieee80211_local *local = hw_to_local(hw);

	return local->tx_led.name;
}
EXPORT_SYMBOL(__ieee80211_get_tx_led_name);

const char *__ieee80211_get_rx_led_name(struct ieee80211_hw *hw)
{
	struct ieee80211_local *local = hw_to_local(hw);

	return local->rx_led.name;
}
EXPORT_SYMBOL(__ieee80211_get_rx_led_name);

static unsigned long tpt_trig_traffic(struct ieee80211_local *local,
				      struct tpt_led_trigger *tpt_trig)
{
	unsigned long traffic, delta;

	traffic = tpt_trig->tx_bytes + tpt_trig->rx_bytes;

	delta = traffic - tpt_trig->prev_traffic;
	tpt_trig->prev_traffic = traffic;
	return DIV_ROUND_UP(delta, 1024 / 8);
}

static void tpt_trig_timer(struct timer_list *t)
{
	struct tpt_led_trigger *tpt_trig = from_timer(tpt_trig, t, timer);
	struct ieee80211_local *local = tpt_trig->local;
	struct led_classdev *led_cdev;
	unsigned long on, off, tpt;
	int i;

	if (!tpt_trig->running)
		return;

	mod_timer(&tpt_trig->timer, round_jiffies(jiffies + HZ));

	tpt = tpt_trig_traffic(local, tpt_trig);

	/* default to just solid on */
	on = 1;
	off = 0;

	for (i = tpt_trig->blink_table_len - 1; i >= 0; i--) {
		if (tpt_trig->blink_table[i].throughput < 0 ||
		    tpt > tpt_trig->blink_table[i].throughput) {
			off = tpt_trig->blink_table[i].blink_time / 2;
			on = tpt_trig->blink_table[i].blink_time - off;
			break;
		}
	}

	read_lock(&local->tpt_led.leddev_list_lock);
	list_for_each_entry(led_cdev, &local->tpt_led.led_cdevs, trig_list)
		led_blink_set(led_cdev, &on, &off);
	read_unlock(&local->tpt_led.leddev_list_lock);
}

const char *
__ieee80211_create_tpt_led_trigger(struct ieee80211_hw *hw,
				   unsigned int flags,
				   const struct ieee80211_tpt_blink *blink_table,
				   unsigned int blink_table_len)
{
	struct ieee80211_local *local = hw_to_local(hw);
	struct tpt_led_trigger *tpt_trig;

	if (WARN_ON(local->tpt_led_trigger))
		return NULL;

	tpt_trig = kzalloc(sizeof(struct tpt_led_trigger), GFP_KERNEL);
	if (!tpt_trig)
		return NULL;

	snprintf(tpt_trig->name, sizeof(tpt_trig->name),
		 "%stpt", wiphy_name(local->hw.wiphy));

	local->tpt_led.name = tpt_trig->name;

	tpt_trig->blink_table = blink_table;
	tpt_trig->blink_table_len = blink_table_len;
	tpt_trig->want = flags;
	tpt_trig->local = local;

	timer_setup(&tpt_trig->timer, tpt_trig_timer, 0);

	local->tpt_led_trigger = tpt_trig;

	return tpt_trig->name;
}
EXPORT_SYMBOL(__ieee80211_create_tpt_led_trigger);

static void ieee80211_start_tpt_led_trig(struct ieee80211_local *local)
{
	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;

	if (tpt_trig->running)
		return;

	/* reset traffic */
	tpt_trig_traffic(local, tpt_trig);
	tpt_trig->running = true;

	tpt_trig_timer(&tpt_trig->timer);
	mod_timer(&tpt_trig->timer, round_jiffies(jiffies + HZ));
}

static void ieee80211_stop_tpt_led_trig(struct ieee80211_local *local)
{
	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	struct led_classdev *led_cdev;

	if (!tpt_trig->running)
		return;

	tpt_trig->running = false;
	del_timer_sync(&tpt_trig->timer);

	read_lock(&local->tpt_led.leddev_list_lock);
	list_for_each_entry(led_cdev, &local->tpt_led.led_cdevs, trig_list)
		led_set_brightness(led_cdev, LED_OFF);
	read_unlock(&local->tpt_led.leddev_list_lock);
}

void ieee80211_mod_tpt_led_trig(struct ieee80211_local *local,
				unsigned int types_on, unsigned int types_off)
{
	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	bool allowed;

	WARN_ON(types_on & types_off);

	if (!tpt_trig)
		return;

	tpt_trig->active &= ~types_off;
	tpt_trig->active |= types_on;

	/*
	 * Regardless of wanted state, we shouldn't blink when
	 * the radio is disabled -- this can happen due to some
	 * code ordering issues with __ieee80211_recalc_idle()
	 * being called before the radio is started.
	 */
	allowed = tpt_trig->active & IEEE80211_TPT_LEDTRIG_FL_RADIO;

	if (!allowed || !(tpt_trig->active & tpt_trig->want))
		ieee80211_stop_tpt_led_trig(local);
	else
		ieee80211_start_tpt_led_trig(local);
}
Commit	Line	Data
f0706e82 JB	1	/*
	2	* Copyright 2006, Johannes Berg <johannes@sipsolutions.net>
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License version 2 as
	6	* published by the Free Software Foundation.
	7	*/
	8
	9	/* just for IFNAMSIZ */
	10	#include <linux/if.h>
5a0e3ad6	11	#include <linux/slab.h>
bc3b2d7f	12	#include <linux/export.h>
2c8dccc7	13	#include "led.h"
f0706e82	14
47f0c502 MB	15	void ieee80211_led_assoc(struct ieee80211_local *local, bool associated)
47f0c502 MB	16	{
8d5c2585	17	if (!atomic_read(&local->assoc_led_active))
47f0c502 MB	18	return;
47f0c502 MB	19	if (associated)
8d5c2585	20	led_trigger_event(&local->assoc_led, LED_FULL);
47f0c502	21	else
8d5c2585	22	led_trigger_event(&local->assoc_led, LED_OFF);
47f0c502 MB	23	}
47f0c502 MB	24
cdcb006f ID	25	void ieee80211_led_radio(struct ieee80211_local *local, bool enabled)
cdcb006f ID	26	{
8d5c2585	27	if (!atomic_read(&local->radio_led_active))
cdcb006f ID	28	return;
cdcb006f ID	29	if (enabled)
8d5c2585	30	led_trigger_event(&local->radio_led, LED_FULL);
cdcb006f	31	else
8d5c2585 JB	32	led_trigger_event(&local->radio_led, LED_OFF);
	33	}
	34
	35	void ieee80211_alloc_led_names(struct ieee80211_local *local)
	36	{
	37	local->rx_led.name = kasprintf(GFP_KERNEL, "%srx",
	38	wiphy_name(local->hw.wiphy));
	39	local->tx_led.name = kasprintf(GFP_KERNEL, "%stx",
	40	wiphy_name(local->hw.wiphy));
	41	local->assoc_led.name = kasprintf(GFP_KERNEL, "%sassoc",
	42	wiphy_name(local->hw.wiphy));
	43	local->radio_led.name = kasprintf(GFP_KERNEL, "%sradio",
	44	wiphy_name(local->hw.wiphy));
	45	}
	46
	47	void ieee80211_free_led_names(struct ieee80211_local *local)
	48	{
	49	kfree(local->rx_led.name);
	50	kfree(local->tx_led.name);
	51	kfree(local->assoc_led.name);
	52	kfree(local->radio_led.name);
	53	}
	54
	55	static void ieee80211_tx_led_activate(struct led_classdev *led_cdev)
	56	{
	57	struct ieee80211_local *local = container_of(led_cdev->trigger,
	58	struct ieee80211_local,
	59	tx_led);
	60
	61	atomic_inc(&local->tx_led_active);
	62	}
	63
	64	static void ieee80211_tx_led_deactivate(struct led_classdev *led_cdev)
	65	{
	66	struct ieee80211_local *local = container_of(led_cdev->trigger,
	67	struct ieee80211_local,
	68	tx_led);
	69
	70	atomic_dec(&local->tx_led_active);
	71	}
	72
	73	static void ieee80211_rx_led_activate(struct led_classdev *led_cdev)
	74	{
	75	struct ieee80211_local *local = container_of(led_cdev->trigger,
	76	struct ieee80211_local,
	77	rx_led);
	78
	79	atomic_inc(&local->rx_led_active);
	80	}
	81
	82	static void ieee80211_rx_led_deactivate(struct led_classdev *led_cdev)
	83	{
	84	struct ieee80211_local *local = container_of(led_cdev->trigger,
	85	struct ieee80211_local,
	86	rx_led);
	87
	88	atomic_dec(&local->rx_led_active);
	89	}
	90
	91	static void ieee80211_assoc_led_activate(struct led_classdev *led_cdev)
	92	{
	93	struct ieee80211_local *local = container_of(led_cdev->trigger,
	94	struct ieee80211_local,
	95	assoc_led);
96
97	atomic_inc(&local->assoc_led_active);
98	}
99
100	static void ieee80211_assoc_led_deactivate(struct led_classdev *led_cdev)
101	{
102	struct ieee80211_local *local = container_of(led_cdev->trigger,
103	struct ieee80211_local,
104	assoc_led);
105
106	atomic_dec(&local->assoc_led_active);
107	}
108
109	static void ieee80211_radio_led_activate(struct led_classdev *led_cdev)
110	{
111	struct ieee80211_local *local = container_of(led_cdev->trigger,
112	struct ieee80211_local,
113	radio_led);
114
115	atomic_inc(&local->radio_led_active);
116	}
117
118	static void ieee80211_radio_led_deactivate(struct led_classdev *led_cdev)
119	{
120	struct ieee80211_local *local = container_of(led_cdev->trigger,
121	struct ieee80211_local,
122	radio_led);
123
124	atomic_dec(&local->radio_led_active);
125	}
126
127	static void ieee80211_tpt_led_activate(struct led_classdev *led_cdev)
128	{
129	struct ieee80211_local *local = container_of(led_cdev->trigger,
130	struct ieee80211_local,
131	tpt_led);
132
133	atomic_inc(&local->tpt_led_active);
cdcb006f ID	134	}
cdcb006f ID	135
8d5c2585	136	static void ieee80211_tpt_led_deactivate(struct led_classdev *led_cdev)
fe67c913	137	{
8d5c2585 JB	138	struct ieee80211_local *local = container_of(led_cdev->trigger,
	139	struct ieee80211_local,
	140	tpt_led);
	141
	142	atomic_dec(&local->tpt_led_active);
fe67c913 JB	143	}
fe67c913 JB	144
f0706e82 JB	145	void ieee80211_led_init(struct ieee80211_local *local)
f0706e82 JB	146	{
8d5c2585 JB	147	atomic_set(&local->rx_led_active, 0);
	148	local->rx_led.activate = ieee80211_rx_led_activate;
	149	local->rx_led.deactivate = ieee80211_rx_led_deactivate;
	150	if (local->rx_led.name && led_trigger_register(&local->rx_led)) {
	151	kfree(local->rx_led.name);
	152	local->rx_led.name = NULL;
f0706e82 JB	153	}
f0706e82 JB	154
8d5c2585 JB	155	atomic_set(&local->tx_led_active, 0);
	156	local->tx_led.activate = ieee80211_tx_led_activate;
	157	local->tx_led.deactivate = ieee80211_tx_led_deactivate;
	158	if (local->tx_led.name && led_trigger_register(&local->tx_led)) {
	159	kfree(local->tx_led.name);
	160	local->tx_led.name = NULL;
47f0c502 MB	161	}
47f0c502 MB	162
8d5c2585 JB	163	atomic_set(&local->assoc_led_active, 0);
	164	local->assoc_led.activate = ieee80211_assoc_led_activate;
	165	local->assoc_led.deactivate = ieee80211_assoc_led_deactivate;
	166	if (local->assoc_led.name && led_trigger_register(&local->assoc_led)) {
	167	kfree(local->assoc_led.name);
	168	local->assoc_led.name = NULL;
f0706e82	169	}
cdcb006f	170
8d5c2585 JB	171	atomic_set(&local->radio_led_active, 0);
	172	local->radio_led.activate = ieee80211_radio_led_activate;
	173	local->radio_led.deactivate = ieee80211_radio_led_deactivate;
	174	if (local->radio_led.name && led_trigger_register(&local->radio_led)) {
	175	kfree(local->radio_led.name);
	176	local->radio_led.name = NULL;
cdcb006f	177	}
e1e54068	178
8d5c2585	179	atomic_set(&local->tpt_led_active, 0);
e1e54068	180	if (local->tpt_led_trigger) {
8d5c2585 JB	181	local->tpt_led.activate = ieee80211_tpt_led_activate;
	182	local->tpt_led.deactivate = ieee80211_tpt_led_deactivate;
	183	if (led_trigger_register(&local->tpt_led)) {
e1e54068 JB	184	kfree(local->tpt_led_trigger);
	185	local->tpt_led_trigger = NULL;
	186	}
	187	}
f0706e82 JB	188	}
	189
	190	void ieee80211_led_exit(struct ieee80211_local *local)
	191	{
8d5c2585 JB	192	if (local->radio_led.name)
	193	led_trigger_unregister(&local->radio_led);
	194	if (local->assoc_led.name)
	195	led_trigger_unregister(&local->assoc_led);
	196	if (local->tx_led.name)
	197	led_trigger_unregister(&local->tx_led);
	198	if (local->rx_led.name)
	199	led_trigger_unregister(&local->rx_led);
e1e54068 JB	200
e1e54068 JB	201	if (local->tpt_led_trigger) {
8d5c2585	202	led_trigger_unregister(&local->tpt_led);
e1e54068 JB	203	kfree(local->tpt_led_trigger);
e1e54068 JB	204	}
f0706e82 JB	205	}
f0706e82 JB	206
f5c4ae07	207	const char __ieee80211_get_radio_led_name(struct ieee80211_hw hw)
cdcb006f ID	208	{
	209	struct ieee80211_local *local = hw_to_local(hw);
	210
8d5c2585	211	return local->radio_led.name;
cdcb006f ID	212	}
	213	EXPORT_SYMBOL(__ieee80211_get_radio_led_name);
	214
f5c4ae07	215	const char __ieee80211_get_assoc_led_name(struct ieee80211_hw hw)
47f0c502 MB	216	{
	217	struct ieee80211_local *local = hw_to_local(hw);
	218
8d5c2585	219	return local->assoc_led.name;
47f0c502 MB	220	}
	221	EXPORT_SYMBOL(__ieee80211_get_assoc_led_name);
	222
f5c4ae07	223	const char __ieee80211_get_tx_led_name(struct ieee80211_hw hw)
f0706e82 JB	224	{
	225	struct ieee80211_local *local = hw_to_local(hw);
	226
8d5c2585	227	return local->tx_led.name;
f0706e82 JB	228	}
	229	EXPORT_SYMBOL(__ieee80211_get_tx_led_name);
	230
f5c4ae07	231	const char __ieee80211_get_rx_led_name(struct ieee80211_hw hw)
f0706e82 JB	232	{
	233	struct ieee80211_local *local = hw_to_local(hw);
	234
8d5c2585	235	return local->rx_led.name;
f0706e82 JB	236	}
f0706e82 JB	237	EXPORT_SYMBOL(__ieee80211_get_rx_led_name);
e1e54068 JB	238
	239	static unsigned long tpt_trig_traffic(struct ieee80211_local *local,
	240	struct tpt_led_trigger *tpt_trig)
	241	{
	242	unsigned long traffic, delta;
	243
	244	traffic = tpt_trig->tx_bytes + tpt_trig->rx_bytes;
	245
	246	delta = traffic - tpt_trig->prev_traffic;
	247	tpt_trig->prev_traffic = traffic;
	248	return DIV_ROUND_UP(delta, 1024 / 8);
	249	}
	250
34f11cd3	251	static void tpt_trig_timer(struct timer_list *t)
e1e54068	252	{
34f11cd3 KC	253	struct tpt_led_trigger *tpt_trig = from_timer(tpt_trig, t, timer);
34f11cd3 KC	254	struct ieee80211_local *local = tpt_trig->local;
e1e54068 JB	255	struct led_classdev *led_cdev;
	256	unsigned long on, off, tpt;
	257	int i;
	258
	259	if (!tpt_trig->running)
	260	return;
	261
	262	mod_timer(&tpt_trig->timer, round_jiffies(jiffies + HZ));
	263
	264	tpt = tpt_trig_traffic(local, tpt_trig);
	265
	266	/* default to just solid on */
	267	on = 1;
	268	off = 0;
	269
	270	for (i = tpt_trig->blink_table_len - 1; i >= 0; i--) {
	271	if (tpt_trig->blink_table[i].throughput < 0 \|\|
	272	tpt > tpt_trig->blink_table[i].throughput) {
	273	off = tpt_trig->blink_table[i].blink_time / 2;
	274	on = tpt_trig->blink_table[i].blink_time - off;
	275	break;
	276	}
	277	}
	278
658358ce JB	279	read_lock(&local->tpt_led.leddev_list_lock);
658358ce JB	280	list_for_each_entry(led_cdev, &local->tpt_led.led_cdevs, trig_list)
e1e54068	281	led_blink_set(led_cdev, &on, &off);
658358ce	282	read_unlock(&local->tpt_led.leddev_list_lock);
e1e54068 JB	283	}
e1e54068 JB	284
f5c4ae07 JB	285	const char *
	286	__ieee80211_create_tpt_led_trigger(struct ieee80211_hw *hw,
	287	unsigned int flags,
	288	const struct ieee80211_tpt_blink *blink_table,
	289	unsigned int blink_table_len)
e1e54068 JB	290	{
	291	struct ieee80211_local *local = hw_to_local(hw);
	292	struct tpt_led_trigger *tpt_trig;
	293
	294	if (WARN_ON(local->tpt_led_trigger))
	295	return NULL;
	296
	297	tpt_trig = kzalloc(sizeof(struct tpt_led_trigger), GFP_KERNEL);
	298	if (!tpt_trig)
	299	return NULL;
	300
	301	snprintf(tpt_trig->name, sizeof(tpt_trig->name),
	302	"%stpt", wiphy_name(local->hw.wiphy));
	303
8d5c2585	304	local->tpt_led.name = tpt_trig->name;
e1e54068 JB	305
	306	tpt_trig->blink_table = blink_table;
	307	tpt_trig->blink_table_len = blink_table_len;
67408c8c	308	tpt_trig->want = flags;
34f11cd3	309	tpt_trig->local = local;
e1e54068	310
34f11cd3	311	timer_setup(&tpt_trig->timer, tpt_trig_timer, 0);
e1e54068 JB	312
	313	local->tpt_led_trigger = tpt_trig;
	314
	315	return tpt_trig->name;
	316	}
	317	EXPORT_SYMBOL(__ieee80211_create_tpt_led_trigger);
	318
67408c8c	319	static void ieee80211_start_tpt_led_trig(struct ieee80211_local *local)
e1e54068 JB	320	{
	321	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	322
67408c8c	323	if (tpt_trig->running)
e1e54068 JB	324	return;
	325
	326	/* reset traffic */
	327	tpt_trig_traffic(local, tpt_trig);
	328	tpt_trig->running = true;
	329
34f11cd3	330	tpt_trig_timer(&tpt_trig->timer);
e1e54068 JB	331	mod_timer(&tpt_trig->timer, round_jiffies(jiffies + HZ));
	332	}
	333
67408c8c	334	static void ieee80211_stop_tpt_led_trig(struct ieee80211_local *local)
e1e54068 JB	335	{
	336	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	337	struct led_classdev *led_cdev;
	338
67408c8c	339	if (!tpt_trig->running)
e1e54068 JB	340	return;
	341
	342	tpt_trig->running = false;
	343	del_timer_sync(&tpt_trig->timer);
	344
658358ce JB	345	read_lock(&local->tpt_led.leddev_list_lock);
658358ce JB	346	list_for_each_entry(led_cdev, &local->tpt_led.led_cdevs, trig_list)
19cd67e2	347	led_set_brightness(led_cdev, LED_OFF);
658358ce	348	read_unlock(&local->tpt_led.leddev_list_lock);
e1e54068	349	}
67408c8c JB	350
	351	void ieee80211_mod_tpt_led_trig(struct ieee80211_local *local,
	352	unsigned int types_on, unsigned int types_off)
	353	{
	354	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	355	bool allowed;
	356
	357	WARN_ON(types_on & types_off);
	358
	359	if (!tpt_trig)
	360	return;
	361
	362	tpt_trig->active &= ~types_off;
	363	tpt_trig->active \|= types_on;
	364
	365	/*
	366	* Regardless of wanted state, we shouldn't blink when
	367	* the radio is disabled -- this can happen due to some
	368	* code ordering issues with __ieee80211_recalc_idle()
	369	* being called before the radio is started.
	370	*/
	371	allowed = tpt_trig->active & IEEE80211_TPT_LEDTRIG_FL_RADIO;
	372
	373	if (!allowed \|\| !(tpt_trig->active & tpt_trig->want))
	374	ieee80211_stop_tpt_led_trig(local);
	375	else
	376	ieee80211_start_tpt_led_trig(local);
	377	}