[mirror_ubuntu-artful-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 "led.h"

void ieee80211_led_rx(struct ieee80211_local *local)
{
	if (unlikely(!local->rx_led))
		return;
	if (local->rx_led_counter++ % 2 == 0)
		led_trigger_event(local->rx_led, LED_OFF);
	else
		led_trigger_event(local->rx_led, LED_FULL);
}

/* q is 1 if a packet was enqueued, 0 if it has been transmitted */
void ieee80211_led_tx(struct ieee80211_local *local, int q)
{
	if (unlikely(!local->tx_led))
		return;
	/* not sure how this is supposed to work ... */
	local->tx_led_counter += 2*q-1;
	if (local->tx_led_counter % 2 == 0)
		led_trigger_event(local->tx_led, LED_OFF);
	else
		led_trigger_event(local->tx_led, LED_FULL);
}

void ieee80211_led_assoc(struct ieee80211_local *local, bool associated)
{
	if (unlikely(!local->assoc_led))
		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 (unlikely(!local->radio_led))
		return;
	if (enabled)
		led_trigger_event(local->radio_led, LED_FULL);
	else
		led_trigger_event(local->radio_led, LED_OFF);
}

void ieee80211_led_names(struct ieee80211_local *local)
{
	snprintf(local->rx_led_name, sizeof(local->rx_led_name),
		 "%srx", wiphy_name(local->hw.wiphy));
	snprintf(local->tx_led_name, sizeof(local->tx_led_name),
		 "%stx", wiphy_name(local->hw.wiphy));
	snprintf(local->assoc_led_name, sizeof(local->assoc_led_name),
		 "%sassoc", wiphy_name(local->hw.wiphy));
	snprintf(local->radio_led_name, sizeof(local->radio_led_name),
		 "%sradio", wiphy_name(local->hw.wiphy));
}

void ieee80211_led_init(struct ieee80211_local *local)
{
	local->rx_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
	if (local->rx_led) {
		local->rx_led->name = local->rx_led_name;
		if (led_trigger_register(local->rx_led)) {
			kfree(local->rx_led);
			local->rx_led = NULL;
		}
	}

	local->tx_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
	if (local->tx_led) {
		local->tx_led->name = local->tx_led_name;
		if (led_trigger_register(local->tx_led)) {
			kfree(local->tx_led);
			local->tx_led = NULL;
		}
	}

	local->assoc_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
	if (local->assoc_led) {
		local->assoc_led->name = local->assoc_led_name;
		if (led_trigger_register(local->assoc_led)) {
			kfree(local->assoc_led);
			local->assoc_led = NULL;
		}
	}

	local->radio_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
	if (local->radio_led) {
		local->radio_led->name = local->radio_led_name;
		if (led_trigger_register(local->radio_led)) {
			kfree(local->radio_led);
			local->radio_led = NULL;
		}
	}

	if (local->tpt_led_trigger) {
		if (led_trigger_register(&local->tpt_led_trigger->trig)) {
			kfree(local->tpt_led_trigger);
			local->tpt_led_trigger = NULL;
		}
	}
}

void ieee80211_led_exit(struct ieee80211_local *local)
{
	if (local->radio_led) {
		led_trigger_unregister(local->radio_led);
		kfree(local->radio_led);
	}
	if (local->assoc_led) {
		led_trigger_unregister(local->assoc_led);
		kfree(local->assoc_led);
	}
	if (local->tx_led) {
		led_trigger_unregister(local->tx_led);
		kfree(local->tx_led);
	}
	if (local->rx_led) {
		led_trigger_unregister(local->rx_led);
		kfree(local->rx_led);
	}

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

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

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

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

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(&tpt_trig->trig.leddev_list_lock);
	list_for_each_entry(led_cdev, &tpt_trig->trig.led_cdevs, trig_list)
		led_blink_set(led_cdev, &on, &off);
	read_unlock(&tpt_trig->trig.leddev_list_lock);
}

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

	tpt_trig->trig.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(&tpt_trig->trig.leddev_list_lock);
	list_for_each_entry(led_cdev, &tpt_trig->trig.led_cdevs, trig_list)
		led_brightness_set(led_cdev, LED_OFF);
	read_unlock(&tpt_trig->trig.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>
2c8dccc7	12	#include "led.h"
f0706e82 JB	13
	14	void ieee80211_led_rx(struct ieee80211_local *local)
	15	{
	16	if (unlikely(!local->rx_led))
	17	return;
	18	if (local->rx_led_counter++ % 2 == 0)
	19	led_trigger_event(local->rx_led, LED_OFF);
	20	else
	21	led_trigger_event(local->rx_led, LED_FULL);
	22	}
	23
	24	/* q is 1 if a packet was enqueued, 0 if it has been transmitted */
	25	void ieee80211_led_tx(struct ieee80211_local *local, int q)
	26	{
	27	if (unlikely(!local->tx_led))
	28	return;
	29	/* not sure how this is supposed to work ... */
	30	local->tx_led_counter += 2*q-1;
	31	if (local->tx_led_counter % 2 == 0)
	32	led_trigger_event(local->tx_led, LED_OFF);
	33	else
	34	led_trigger_event(local->tx_led, LED_FULL);
	35	}
	36
47f0c502 MB	37	void ieee80211_led_assoc(struct ieee80211_local *local, bool associated)
	38	{
	39	if (unlikely(!local->assoc_led))
	40	return;
	41	if (associated)
	42	led_trigger_event(local->assoc_led, LED_FULL);
	43	else
	44	led_trigger_event(local->assoc_led, LED_OFF);
	45	}
	46
cdcb006f ID	47	void ieee80211_led_radio(struct ieee80211_local *local, bool enabled)
	48	{
	49	if (unlikely(!local->radio_led))
	50	return;
	51	if (enabled)
	52	led_trigger_event(local->radio_led, LED_FULL);
	53	else
	54	led_trigger_event(local->radio_led, LED_OFF);
	55	}
	56
fe67c913 JB	57	void ieee80211_led_names(struct ieee80211_local *local)
	58	{
	59	snprintf(local->rx_led_name, sizeof(local->rx_led_name),
	60	"%srx", wiphy_name(local->hw.wiphy));
	61	snprintf(local->tx_led_name, sizeof(local->tx_led_name),
	62	"%stx", wiphy_name(local->hw.wiphy));
	63	snprintf(local->assoc_led_name, sizeof(local->assoc_led_name),
	64	"%sassoc", wiphy_name(local->hw.wiphy));
	65	snprintf(local->radio_led_name, sizeof(local->radio_led_name),
	66	"%sradio", wiphy_name(local->hw.wiphy));
	67	}
	68
f0706e82 JB	69	void ieee80211_led_init(struct ieee80211_local *local)
	70	{
	71	local->rx_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
47f0c502	72	if (local->rx_led) {
47f0c502 MB	73	local->rx_led->name = local->rx_led_name;
	74	if (led_trigger_register(local->rx_led)) {
	75	kfree(local->rx_led);
	76	local->rx_led = NULL;
	77	}
f0706e82 JB	78	}
	79
	80	local->tx_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
47f0c502	81	if (local->tx_led) {
47f0c502 MB	82	local->tx_led->name = local->tx_led_name;
	83	if (led_trigger_register(local->tx_led)) {
	84	kfree(local->tx_led);
	85	local->tx_led = NULL;
	86	}
	87	}
	88
	89	local->assoc_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
	90	if (local->assoc_led) {
47f0c502 MB	91	local->assoc_led->name = local->assoc_led_name;
	92	if (led_trigger_register(local->assoc_led)) {
	93	kfree(local->assoc_led);
	94	local->assoc_led = NULL;
	95	}
f0706e82	96	}
cdcb006f ID	97
	98	local->radio_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
	99	if (local->radio_led) {
cdcb006f ID	100	local->radio_led->name = local->radio_led_name;
	101	if (led_trigger_register(local->radio_led)) {
	102	kfree(local->radio_led);
	103	local->radio_led = NULL;
	104	}
	105	}
e1e54068 JB	106
	107	if (local->tpt_led_trigger) {
	108	if (led_trigger_register(&local->tpt_led_trigger->trig)) {
	109	kfree(local->tpt_led_trigger);
	110	local->tpt_led_trigger = NULL;
	111	}
	112	}
f0706e82 JB	113	}
	114
	115	void ieee80211_led_exit(struct ieee80211_local *local)
	116	{
cdcb006f ID	117	if (local->radio_led) {
	118	led_trigger_unregister(local->radio_led);
	119	kfree(local->radio_led);
	120	}
47f0c502 MB	121	if (local->assoc_led) {
	122	led_trigger_unregister(local->assoc_led);
	123	kfree(local->assoc_led);
	124	}
f0706e82 JB	125	if (local->tx_led) {
	126	led_trigger_unregister(local->tx_led);
	127	kfree(local->tx_led);
	128	}
	129	if (local->rx_led) {
	130	led_trigger_unregister(local->rx_led);
	131	kfree(local->rx_led);
	132	}
e1e54068 JB	133
	134	if (local->tpt_led_trigger) {
	135	led_trigger_unregister(&local->tpt_led_trigger->trig);
	136	kfree(local->tpt_led_trigger);
	137	}
f0706e82 JB	138	}
f0706e82 JB	139
cdcb006f ID	140	char __ieee80211_get_radio_led_name(struct ieee80211_hw hw)
	141	{
	142	struct ieee80211_local *local = hw_to_local(hw);
	143
fe67c913	144	return local->radio_led_name;
cdcb006f ID	145	}
	146	EXPORT_SYMBOL(__ieee80211_get_radio_led_name);
	147
47f0c502 MB	148	char __ieee80211_get_assoc_led_name(struct ieee80211_hw hw)
	149	{
	150	struct ieee80211_local *local = hw_to_local(hw);
	151
fe67c913	152	return local->assoc_led_name;
47f0c502 MB	153	}
	154	EXPORT_SYMBOL(__ieee80211_get_assoc_led_name);
	155
f0706e82 JB	156	char __ieee80211_get_tx_led_name(struct ieee80211_hw hw)
	157	{
	158	struct ieee80211_local *local = hw_to_local(hw);
	159
fe67c913	160	return local->tx_led_name;
f0706e82 JB	161	}
	162	EXPORT_SYMBOL(__ieee80211_get_tx_led_name);
	163
	164	char __ieee80211_get_rx_led_name(struct ieee80211_hw hw)
	165	{
	166	struct ieee80211_local *local = hw_to_local(hw);
	167
fe67c913	168	return local->rx_led_name;
f0706e82 JB	169	}
f0706e82 JB	170	EXPORT_SYMBOL(__ieee80211_get_rx_led_name);
e1e54068 JB	171
	172	static unsigned long tpt_trig_traffic(struct ieee80211_local *local,
	173	struct tpt_led_trigger *tpt_trig)
	174	{
	175	unsigned long traffic, delta;
	176
	177	traffic = tpt_trig->tx_bytes + tpt_trig->rx_bytes;
	178
	179	delta = traffic - tpt_trig->prev_traffic;
	180	tpt_trig->prev_traffic = traffic;
	181	return DIV_ROUND_UP(delta, 1024 / 8);
	182	}
	183
	184	static void tpt_trig_timer(unsigned long data)
	185	{
	186	struct ieee80211_local local = (void )data;
	187	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	188	struct led_classdev *led_cdev;
	189	unsigned long on, off, tpt;
	190	int i;
	191
	192	if (!tpt_trig->running)
	193	return;
	194
	195	mod_timer(&tpt_trig->timer, round_jiffies(jiffies + HZ));
	196
	197	tpt = tpt_trig_traffic(local, tpt_trig);
	198
	199	/* default to just solid on */
	200	on = 1;
	201	off = 0;
	202
	203	for (i = tpt_trig->blink_table_len - 1; i >= 0; i--) {
	204	if (tpt_trig->blink_table[i].throughput < 0 \|\|
	205	tpt > tpt_trig->blink_table[i].throughput) {
	206	off = tpt_trig->blink_table[i].blink_time / 2;
	207	on = tpt_trig->blink_table[i].blink_time - off;
	208	break;
	209	}
	210	}
	211
	212	read_lock(&tpt_trig->trig.leddev_list_lock);
	213	list_for_each_entry(led_cdev, &tpt_trig->trig.led_cdevs, trig_list)
	214	led_blink_set(led_cdev, &on, &off);
	215	read_unlock(&tpt_trig->trig.leddev_list_lock);
	216	}
	217
	218	extern char *__ieee80211_create_tpt_led_trigger(
67408c8c	219	struct ieee80211_hw *hw, unsigned int flags,
e1e54068 JB	220	const struct ieee80211_tpt_blink *blink_table,
	221	unsigned int blink_table_len)
	222	{
	223	struct ieee80211_local *local = hw_to_local(hw);
	224	struct tpt_led_trigger *tpt_trig;
	225
	226	if (WARN_ON(local->tpt_led_trigger))
	227	return NULL;
	228
	229	tpt_trig = kzalloc(sizeof(struct tpt_led_trigger), GFP_KERNEL);
	230	if (!tpt_trig)
	231	return NULL;
	232
	233	snprintf(tpt_trig->name, sizeof(tpt_trig->name),
	234	"%stpt", wiphy_name(local->hw.wiphy));
	235
	236	tpt_trig->trig.name = tpt_trig->name;
	237
	238	tpt_trig->blink_table = blink_table;
	239	tpt_trig->blink_table_len = blink_table_len;
67408c8c	240	tpt_trig->want = flags;
e1e54068 JB	241
	242	setup_timer(&tpt_trig->timer, tpt_trig_timer, (unsigned long)local);
	243
	244	local->tpt_led_trigger = tpt_trig;
	245
	246	return tpt_trig->name;
	247	}
	248	EXPORT_SYMBOL(__ieee80211_create_tpt_led_trigger);
	249
67408c8c	250	static void ieee80211_start_tpt_led_trig(struct ieee80211_local *local)
e1e54068 JB	251	{
	252	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	253
67408c8c	254	if (tpt_trig->running)
e1e54068 JB	255	return;
	256
	257	/* reset traffic */
	258	tpt_trig_traffic(local, tpt_trig);
	259	tpt_trig->running = true;
	260
	261	tpt_trig_timer((unsigned long)local);
	262	mod_timer(&tpt_trig->timer, round_jiffies(jiffies + HZ));
	263	}
	264
67408c8c	265	static void ieee80211_stop_tpt_led_trig(struct ieee80211_local *local)
e1e54068 JB	266	{
	267	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	268	struct led_classdev *led_cdev;
	269
67408c8c	270	if (!tpt_trig->running)
e1e54068 JB	271	return;
	272
	273	tpt_trig->running = false;
	274	del_timer_sync(&tpt_trig->timer);
	275
	276	read_lock(&tpt_trig->trig.leddev_list_lock);
	277	list_for_each_entry(led_cdev, &tpt_trig->trig.led_cdevs, trig_list)
	278	led_brightness_set(led_cdev, LED_OFF);
	279	read_unlock(&tpt_trig->trig.leddev_list_lock);
	280	}
67408c8c JB	281
	282	void ieee80211_mod_tpt_led_trig(struct ieee80211_local *local,
	283	unsigned int types_on, unsigned int types_off)
	284	{
	285	struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
	286	bool allowed;
	287
	288	WARN_ON(types_on & types_off);
	289
	290	if (!tpt_trig)
	291	return;
	292
	293	tpt_trig->active &= ~types_off;
	294	tpt_trig->active \|= types_on;
	295
	296	/*
	297	* Regardless of wanted state, we shouldn't blink when
	298	* the radio is disabled -- this can happen due to some
	299	* code ordering issues with __ieee80211_recalc_idle()
	300	* being called before the radio is started.
	301	*/
	302	allowed = tpt_trig->active & IEEE80211_TPT_LEDTRIG_FL_RADIO;
	303
	304	if (!allowed \|\| !(tpt_trig->active & tpt_trig->want))
	305	ieee80211_stop_tpt_led_trig(local);
	306	else
	307	ieee80211_start_tpt_led_trig(local);
	308	}