[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 <linux/workqueue.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;
	}

	queue_delayed_work(system_wq, &led_cdev->blink_work, 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)
{
	cancel_delayed_work_sync(&led_cdev->blink_work);

	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) &&
	     delayed_work_pending(&led_cdev->blink_work))
		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)
{
	cancel_delayed_work_sync(&led_cdev->blink_work);
	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 work */
	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	18	#include <linux/leds.h>
8b37e1be	19	#include <linux/workqueue.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 */
	44	if (!delay_on) {
	45	__led_set_brightness(led_cdev, LED_OFF);
a403d930	46	return;
8d82fef8	47	}
a403d930 BW	48
	49	/* never off - just set to brightness */
	50	if (!delay_off) {
0da3e65b	51	__led_set_brightness(led_cdev, led_cdev->blink_brightness);
a403d930 BW	52	return;
	53	}
	54
8b37e1be	55	queue_delayed_work(system_wq, &led_cdev->blink_work, 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	{
8b37e1be	79	cancel_delayed_work_sync(&led_cdev->blink_work);
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) &&
8b37e1be	94	delayed_work_pending(&led_cdev->blink_work))
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	{
8b37e1be	111	cancel_delayed_work_sync(&led_cdev->blink_work);
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	{
8b37e1be	120	/* delay brightness setting if need to stop soft-blink work */
d23a22a7 FB	121	if (led_cdev->blink_delay_on \|\| led_cdev->blink_delay_off) {
	122	led_cdev->delayed_set_value = brightness;
	123	schedule_work(&led_cdev->set_brightness_work);
	124	return;
	125	}
43786482	126
0da3e65b	127	__led_set_brightness(led_cdev, brightness);
a403d930	128	}
19cd67e2	129	EXPORT_SYMBOL(led_set_brightness);