[deliverable/linux.git] / drivers / leds / led-core.c

/*
 * LED Class Core
 *
 * Copyright 2005-2006 Openedhand Ltd.
 *
 * Author: Richard Purdie <rpurdie@openedhand.com>
 *
 * 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.
 *
 */

#include <linux/kernel.h>
#include <linux/leds.h>
#include <linux/list.h>
#include <linux/module.h>
#include <linux/mutex.h>
#include <linux/rwsem.h>
#include "leds.h"

DECLARE_RWSEM(leds_list_lock);
EXPORT_SYMBOL_GPL(leds_list_lock);

LIST_HEAD(leds_list);
EXPORT_SYMBOL_GPL(leds_list);

static void led_set_software_blink(struct led_classdev *led_cdev,
				   unsigned long delay_on,
				   unsigned long delay_off)
{
	int current_brightness;

	current_brightness = led_get_brightness(led_cdev);
	if (current_brightness)
		led_cdev->blink_brightness = current_brightness;
	if (!led_cdev->blink_brightness)
		led_cdev->blink_brightness = led_cdev->max_brightness;

	led_cdev->blink_delay_on = delay_on;
	led_cdev->blink_delay_off = delay_off;

	/* never on - just set to off */
	if (!delay_on) {
		led_set_brightness_async(led_cdev, LED_OFF);
		return;
	}

	/* never off - just set to brightness */
	if (!delay_off) {
		led_set_brightness_async(led_cdev, led_cdev->blink_brightness);
		return;
	}

	mod_timer(&led_cdev->blink_timer, jiffies + 1);
}


static void led_blink_setup(struct led_classdev *led_cdev,
		     unsigned long *delay_on,
		     unsigned long *delay_off)
{
	if (!(led_cdev->flags & LED_BLINK_ONESHOT) &&
	    led_cdev->blink_set &&
	    !led_cdev->blink_set(led_cdev, delay_on, delay_off))
		return;

	/* blink with 1 Hz as default if nothing specified */
	if (!*delay_on && !*delay_off)
		*delay_on = *delay_off = 500;

	led_set_software_blink(led_cdev, *delay_on, *delay_off);
}

void led_blink_set(struct led_classdev *led_cdev,
		   unsigned long *delay_on,
		   unsigned long *delay_off)
{
	del_timer_sync(&led_cdev->blink_timer);

	led_cdev->flags &= ~LED_BLINK_ONESHOT;
	led_cdev->flags &= ~LED_BLINK_ONESHOT_STOP;

	led_blink_setup(led_cdev, delay_on, delay_off);
}
EXPORT_SYMBOL(led_blink_set);

void led_blink_set_oneshot(struct led_classdev *led_cdev,
			   unsigned long *delay_on,
			   unsigned long *delay_off,
			   int invert)
{
	if ((led_cdev->flags & LED_BLINK_ONESHOT) &&
	     timer_pending(&led_cdev->blink_timer))
		return;

	led_cdev->flags |= LED_BLINK_ONESHOT;
	led_cdev->flags &= ~LED_BLINK_ONESHOT_STOP;

	if (invert)
		led_cdev->flags |= LED_BLINK_INVERT;
	else
		led_cdev->flags &= ~LED_BLINK_INVERT;

	led_blink_setup(led_cdev, delay_on, delay_off);
}
EXPORT_SYMBOL(led_blink_set_oneshot);

void led_stop_software_blink(struct led_classdev *led_cdev)
{
	del_timer_sync(&led_cdev->blink_timer);
	led_cdev->blink_delay_on = 0;
	led_cdev->blink_delay_off = 0;
}
EXPORT_SYMBOL_GPL(led_stop_software_blink);

void led_set_brightness(struct led_classdev *led_cdev,
			enum led_brightness brightness)
{
	int ret = 0;

	/* delay brightness setting if need to stop soft-blink timer */
	if (led_cdev->blink_delay_on || led_cdev->blink_delay_off) {
		led_cdev->delayed_set_value = brightness;
		schedule_work(&led_cdev->set_brightness_work);
		return;
	}

	if (led_cdev->flags & SET_BRIGHTNESS_ASYNC) {
		led_set_brightness_async(led_cdev, brightness);
		return;
	} else if (led_cdev->flags & SET_BRIGHTNESS_SYNC)
		ret = led_set_brightness_sync(led_cdev, brightness);
	else
		ret = -EINVAL;

	if (ret < 0)
		dev_dbg(led_cdev->dev, "Setting LED brightness failed (%d)\n",
			ret);
}
EXPORT_SYMBOL(led_set_brightness);

int led_update_brightness(struct led_classdev *led_cdev)
{
	int ret = 0;

	if (led_cdev->brightness_get) {
		ret = led_cdev->brightness_get(led_cdev);
		if (ret >= 0) {
			led_cdev->brightness = ret;
			return 0;
		}
	}

	return ret;
}
EXPORT_SYMBOL(led_update_brightness);

/* Caller must ensure led_cdev->led_access held */
void led_sysfs_disable(struct led_classdev *led_cdev)
{
	lockdep_assert_held(&led_cdev->led_access);

	led_cdev->flags |= LED_SYSFS_DISABLE;
}
EXPORT_SYMBOL_GPL(led_sysfs_disable);

/* Caller must ensure led_cdev->led_access held */
void led_sysfs_enable(struct led_classdev *led_cdev)
{
	lockdep_assert_held(&led_cdev->led_access);

	led_cdev->flags &= ~LED_SYSFS_DISABLE;
}
EXPORT_SYMBOL_GPL(led_sysfs_enable);
Commit	Line	Data
c72a1d60 RP	1	/*
	2	* LED Class Core
	3	*
	4	* Copyright 2005-2006 Openedhand Ltd.
	5	*
	6	* Author: Richard Purdie <rpurdie@openedhand.com>
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License version 2 as
	10	* published by the Free Software Foundation.
	11	*
	12	*/
	13
	14	#include <linux/kernel.h>
04713306	15	#include <linux/leds.h>
c72a1d60 RP	16	#include <linux/list.h>
c72a1d60 RP	17	#include <linux/module.h>
04713306	18	#include <linux/mutex.h>
72f8da32	19	#include <linux/rwsem.h>
c72a1d60 RP	20	#include "leds.h"
c72a1d60 RP	21
72f8da32	22	DECLARE_RWSEM(leds_list_lock);
4d404fd5	23	EXPORT_SYMBOL_GPL(leds_list_lock);
c72a1d60	24
4d404fd5	25	LIST_HEAD(leds_list);
c72a1d60	26	EXPORT_SYMBOL_GPL(leds_list);
a403d930	27
a403d930 BW	28	static void led_set_software_blink(struct led_classdev *led_cdev,
	29	unsigned long delay_on,
	30	unsigned long delay_off)
	31	{
	32	int current_brightness;
	33
	34	current_brightness = led_get_brightness(led_cdev);
	35	if (current_brightness)
	36	led_cdev->blink_brightness = current_brightness;
	37	if (!led_cdev->blink_brightness)
	38	led_cdev->blink_brightness = led_cdev->max_brightness;
	39
a403d930 BW	40	led_cdev->blink_delay_on = delay_on;
	41	led_cdev->blink_delay_off = delay_off;
	42
8d82fef8 SS	43	/* never on - just set to off */
8d82fef8 SS	44	if (!delay_on) {
4d71a4a1	45	led_set_brightness_async(led_cdev, LED_OFF);
a403d930	46	return;
8d82fef8	47	}
a403d930 BW	48
	49	/* never off - just set to brightness */
	50	if (!delay_off) {
4d71a4a1	51	led_set_brightness_async(led_cdev, led_cdev->blink_brightness);
a403d930 BW	52	return;
	53	}
	54
9067359f	55	mod_timer(&led_cdev->blink_timer, jiffies + 1);
a403d930 BW	56	}
	57
	58
20c0e6b8	59	static void led_blink_setup(struct led_classdev *led_cdev,
5bb629c5 FB	60	unsigned long *delay_on,
5bb629c5 FB	61	unsigned long *delay_off)
a403d930	62	{
5bb629c5 FB	63	if (!(led_cdev->flags & LED_BLINK_ONESHOT) &&
5bb629c5 FB	64	led_cdev->blink_set &&
a403d930 BW	65	!led_cdev->blink_set(led_cdev, delay_on, delay_off))
	66	return;
	67
	68	/* blink with 1 Hz as default if nothing specified */
	69	if (!delay_on && !delay_off)
	70	delay_on = delay_off = 500;
	71
	72	led_set_software_blink(led_cdev, delay_on, delay_off);
	73	}
5bb629c5 FB	74
	75	void led_blink_set(struct led_classdev *led_cdev,
	76	unsigned long *delay_on,
	77	unsigned long *delay_off)
	78	{
9067359f	79	del_timer_sync(&led_cdev->blink_timer);
5bb629c5 FB	80
	81	led_cdev->flags &= ~LED_BLINK_ONESHOT;
	82	led_cdev->flags &= ~LED_BLINK_ONESHOT_STOP;
	83
	84	led_blink_setup(led_cdev, delay_on, delay_off);
	85	}
a403d930 BW	86	EXPORT_SYMBOL(led_blink_set);
a403d930 BW	87
5bb629c5 FB	88	void led_blink_set_oneshot(struct led_classdev *led_cdev,
	89	unsigned long *delay_on,
	90	unsigned long *delay_off,
	91	int invert)
	92	{
	93	if ((led_cdev->flags & LED_BLINK_ONESHOT) &&
9067359f	94	timer_pending(&led_cdev->blink_timer))
5bb629c5 FB	95	return;
	96
	97	led_cdev->flags \|= LED_BLINK_ONESHOT;
	98	led_cdev->flags &= ~LED_BLINK_ONESHOT_STOP;
	99
	100	if (invert)
	101	led_cdev->flags \|= LED_BLINK_INVERT;
	102	else
	103	led_cdev->flags &= ~LED_BLINK_INVERT;
	104
	105	led_blink_setup(led_cdev, delay_on, delay_off);
	106	}
	107	EXPORT_SYMBOL(led_blink_set_oneshot);
	108
d23a22a7	109	void led_stop_software_blink(struct led_classdev *led_cdev)
a403d930	110	{
9067359f	111	del_timer_sync(&led_cdev->blink_timer);
43786482 FB	112	led_cdev->blink_delay_on = 0;
43786482 FB	113	led_cdev->blink_delay_off = 0;
d23a22a7 FB	114	}
	115	EXPORT_SYMBOL_GPL(led_stop_software_blink);
	116
	117	void led_set_brightness(struct led_classdev *led_cdev,
	118	enum led_brightness brightness)
	119	{
4d71a4a1 JA	120	int ret = 0;
4d71a4a1 JA	121
9067359f	122	/* delay brightness setting if need to stop soft-blink timer */
d23a22a7 FB	123	if (led_cdev->blink_delay_on \|\| led_cdev->blink_delay_off) {
	124	led_cdev->delayed_set_value = brightness;
	125	schedule_work(&led_cdev->set_brightness_work);
	126	return;
	127	}
43786482	128
4d71a4a1 JA	129	if (led_cdev->flags & SET_BRIGHTNESS_ASYNC) {
	130	led_set_brightness_async(led_cdev, brightness);
	131	return;
	132	} else if (led_cdev->flags & SET_BRIGHTNESS_SYNC)
	133	ret = led_set_brightness_sync(led_cdev, brightness);
	134	else
	135	ret = -EINVAL;
	136
	137	if (ret < 0)
	138	dev_dbg(led_cdev->dev, "Setting LED brightness failed (%d)\n",
	139	ret);
a403d930	140	}
19cd67e2	141	EXPORT_SYMBOL(led_set_brightness);
3ef7de53 JA	142
	143	int led_update_brightness(struct led_classdev *led_cdev)
	144	{
	145	int ret = 0;
	146
	147	if (led_cdev->brightness_get) {
	148	ret = led_cdev->brightness_get(led_cdev);
	149	if (ret >= 0) {
	150	led_cdev->brightness = ret;
	151	return 0;
	152	}
	153	}
	154
	155	return ret;
	156	}
	157	EXPORT_SYMBOL(led_update_brightness);
acd899e4 JA	158
	159	/* Caller must ensure led_cdev->led_access held */
	160	void led_sysfs_disable(struct led_classdev *led_cdev)
	161	{
	162	lockdep_assert_held(&led_cdev->led_access);
	163
	164	led_cdev->flags \|= LED_SYSFS_DISABLE;
	165	}
	166	EXPORT_SYMBOL_GPL(led_sysfs_disable);
	167
	168	/* Caller must ensure led_cdev->led_access held */
	169	void led_sysfs_enable(struct led_classdev *led_cdev)
	170	{
	171	lockdep_assert_held(&led_cdev->led_access);
	172
	173	led_cdev->flags &= ~LED_SYSFS_DISABLE;
	174	}
	175	EXPORT_SYMBOL_GPL(led_sysfs_enable);