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

	return 0;
}

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

	return 0;
}

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

	return 0;
}

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

	return 0;
}

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

	return 0;
}

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