[linux-2.6-block.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(unsigned long data)
{
	struct ieee80211_local *local = (void *)data;
	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	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;

	setup_timer(&tpt_trig->timer, tpt_trig_timer, (unsigned long)local);

	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((unsigned long)local);
	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
	251	static void tpt_trig_timer(unsigned long data)
	252	{
	253	struct ieee80211_local local = (void )data;
	254	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	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;
e1e54068 JB	309
	310	setup_timer(&tpt_trig->timer, tpt_trig_timer, (unsigned long)local);
	311
	312	local->tpt_led_trigger = tpt_trig;
	313
	314	return tpt_trig->name;
	315	}
	316	EXPORT_SYMBOL(__ieee80211_create_tpt_led_trigger);
	317
67408c8c	318	static void ieee80211_start_tpt_led_trig(struct ieee80211_local *local)
e1e54068 JB	319	{
	320	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	321
67408c8c	322	if (tpt_trig->running)
e1e54068 JB	323	return;
	324
	325	/* reset traffic */
	326	tpt_trig_traffic(local, tpt_trig);
	327	tpt_trig->running = true;
	328
	329	tpt_trig_timer((unsigned long)local);
	330	mod_timer(&tpt_trig->timer, round_jiffies(jiffies + HZ));
	331	}
	332
67408c8c	333	static void ieee80211_stop_tpt_led_trig(struct ieee80211_local *local)
e1e54068 JB	334	{
	335	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	336	struct led_classdev *led_cdev;
	337
67408c8c	338	if (!tpt_trig->running)
e1e54068 JB	339	return;
	340
	341	tpt_trig->running = false;
	342	del_timer_sync(&tpt_trig->timer);
	343
658358ce JB	344	read_lock(&local->tpt_led.leddev_list_lock);
658358ce JB	345	list_for_each_entry(led_cdev, &local->tpt_led.led_cdevs, trig_list)
19cd67e2	346	led_set_brightness(led_cdev, LED_OFF);
658358ce	347	read_unlock(&local->tpt_led.leddev_list_lock);
e1e54068	348	}
67408c8c JB	349
	350	void ieee80211_mod_tpt_led_trig(struct ieee80211_local *local,
	351	unsigned int types_on, unsigned int types_off)
	352	{
	353	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	354	bool allowed;
	355
	356	WARN_ON(types_on & types_off);
	357
	358	if (!tpt_trig)
	359	return;
	360
	361	tpt_trig->active &= ~types_off;
	362	tpt_trig->active \|= types_on;
	363
	364	/*
	365	* Regardless of wanted state, we shouldn't blink when
	366	* the radio is disabled -- this can happen due to some
	367	* code ordering issues with __ieee80211_recalc_idle()
	368	* being called before the radio is started.
	369	*/
	370	allowed = tpt_trig->active & IEEE80211_TPT_LEDTRIG_FL_RADIO;
	371
	372	if (!allowed \|\| !(tpt_trig->active & tpt_trig->want))
	373	ieee80211_stop_tpt_led_trig(local);
	374	else
	375	ieee80211_start_tpt_led_trig(local);
	376	}