[GitHub/mt8127/android_kernel_alcatel_ttab.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_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);
}

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