[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 <linux/export.h>
#include "led.h"

#define MAC80211_BLINK_DELAY 50 /* ms */

void ieee80211_led_rx(struct ieee80211_local *local)
{
	unsigned long led_delay = MAC80211_BLINK_DELAY;
	if (unlikely(!local->rx_led))
		return;
	led_trigger_blink_oneshot(local->rx_led, &led_delay, &led_delay, 0);
}

void ieee80211_led_tx(struct ieee80211_local *local)
{
	unsigned long led_delay = MAC80211_BLINK_DELAY;
	if (unlikely(!local->tx_led))
		return;
	led_trigger_blink_oneshot(local->tx_led, &led_delay, &led_delay, 0);
}

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

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(&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);
}

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

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