[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/list.h>
#include <linux/module.h>
#include <linux/rwsem.h>
#include <linux/leds.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(led_cdev, LED_OFF);
		return;
	}

	/* never off - just set to brightness */
	if (!delay_off) {
		__led_set_brightness(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)
{
	/* 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;
	}

	__led_set_brightness(led_cdev, brightness);
}
EXPORT_SYMBOL(led_set_brightness);
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>
	15	#include <linux/list.h>
	16	#include <linux/module.h>
72f8da32	17	#include <linux/rwsem.h>
c72a1d60 RP	18	#include <linux/leds.h>
	19	#include "leds.h"
	20
72f8da32	21	DECLARE_RWSEM(leds_list_lock);
4d404fd5	22	EXPORT_SYMBOL_GPL(leds_list_lock);
c72a1d60	23
4d404fd5	24	LIST_HEAD(leds_list);
c72a1d60	25	EXPORT_SYMBOL_GPL(leds_list);
a403d930	26
a403d930 BW	27	static void led_set_software_blink(struct led_classdev *led_cdev,
	28	unsigned long delay_on,
	29	unsigned long delay_off)
	30	{
	31	int current_brightness;
	32
	33	current_brightness = led_get_brightness(led_cdev);
	34	if (current_brightness)
	35	led_cdev->blink_brightness = current_brightness;
	36	if (!led_cdev->blink_brightness)
	37	led_cdev->blink_brightness = led_cdev->max_brightness;
	38
a403d930 BW	39	led_cdev->blink_delay_on = delay_on;
	40	led_cdev->blink_delay_off = delay_off;
	41
8d82fef8 SS	42	/* never on - just set to off */
	43	if (!delay_on) {
	44	__led_set_brightness(led_cdev, LED_OFF);
a403d930	45	return;
8d82fef8	46	}
a403d930 BW	47
	48	/* never off - just set to brightness */
	49	if (!delay_off) {
0da3e65b	50	__led_set_brightness(led_cdev, led_cdev->blink_brightness);
a403d930 BW	51	return;
	52	}
	53
	54	mod_timer(&led_cdev->blink_timer, jiffies + 1);
	55	}
	56
	57
20c0e6b8	58	static void led_blink_setup(struct led_classdev *led_cdev,
5bb629c5 FB	59	unsigned long *delay_on,
5bb629c5 FB	60	unsigned long *delay_off)
a403d930	61	{
5bb629c5 FB	62	if (!(led_cdev->flags & LED_BLINK_ONESHOT) &&
5bb629c5 FB	63	led_cdev->blink_set &&
a403d930 BW	64	!led_cdev->blink_set(led_cdev, delay_on, delay_off))
	65	return;
	66
	67	/* blink with 1 Hz as default if nothing specified */
	68	if (!delay_on && !delay_off)
	69	delay_on = delay_off = 500;
	70
	71	led_set_software_blink(led_cdev, delay_on, delay_off);
	72	}
5bb629c5 FB	73
	74	void led_blink_set(struct led_classdev *led_cdev,
	75	unsigned long *delay_on,
	76	unsigned long *delay_off)
	77	{
	78	del_timer_sync(&led_cdev->blink_timer);
	79
	80	led_cdev->flags &= ~LED_BLINK_ONESHOT;
	81	led_cdev->flags &= ~LED_BLINK_ONESHOT_STOP;
	82
	83	led_blink_setup(led_cdev, delay_on, delay_off);
	84	}
a403d930 BW	85	EXPORT_SYMBOL(led_blink_set);
a403d930 BW	86
5bb629c5 FB	87	void led_blink_set_oneshot(struct led_classdev *led_cdev,
	88	unsigned long *delay_on,
	89	unsigned long *delay_off,
	90	int invert)
	91	{
	92	if ((led_cdev->flags & LED_BLINK_ONESHOT) &&
	93	timer_pending(&led_cdev->blink_timer))
	94	return;
	95
	96	led_cdev->flags \|= LED_BLINK_ONESHOT;
	97	led_cdev->flags &= ~LED_BLINK_ONESHOT_STOP;
	98
	99	if (invert)
	100	led_cdev->flags \|= LED_BLINK_INVERT;
	101	else
	102	led_cdev->flags &= ~LED_BLINK_INVERT;
	103
	104	led_blink_setup(led_cdev, delay_on, delay_off);
	105	}
	106	EXPORT_SYMBOL(led_blink_set_oneshot);
	107
d23a22a7	108	void led_stop_software_blink(struct led_classdev *led_cdev)
a403d930	109	{
43786482 FB	110	del_timer_sync(&led_cdev->blink_timer);
	111	led_cdev->blink_delay_on = 0;
	112	led_cdev->blink_delay_off = 0;
d23a22a7 FB	113	}
	114	EXPORT_SYMBOL_GPL(led_stop_software_blink);
	115
	116	void led_set_brightness(struct led_classdev *led_cdev,
	117	enum led_brightness brightness)
	118	{
	119	/* delay brightness setting if need to stop soft-blink timer */
	120	if (led_cdev->blink_delay_on \|\| led_cdev->blink_delay_off) {
	121	led_cdev->delayed_set_value = brightness;
	122	schedule_work(&led_cdev->set_brightness_work);
	123	return;
	124	}
43786482	125
0da3e65b	126	__led_set_brightness(led_cdev, brightness);
a403d930	127	}
19cd67e2	128	EXPORT_SYMBOL(led_set_brightness);