109 lines
2.4 KiB
C
109 lines
2.4 KiB
C
/*
|
|
* LED Triggers Core
|
|
* For the HP Jornada 620/660/680/690 handhelds
|
|
*
|
|
* Copyright 2008 Kristoffer Ericson <kristoffer.ericson@gmail.com>
|
|
* this driver is based on leds-spitz.c by Richard Purdie.
|
|
*
|
|
* 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/init.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/leds.h>
|
|
#include <asm/hd64461.h>
|
|
#include <mach/hp6xx.h>
|
|
|
|
static void hp6xxled_green_set(struct led_classdev *led_cdev,
|
|
enum led_brightness value)
|
|
{
|
|
u8 v8;
|
|
|
|
v8 = inb(PKDR);
|
|
if (value)
|
|
outb(v8 & (~PKDR_LED_GREEN), PKDR);
|
|
else
|
|
outb(v8 | PKDR_LED_GREEN, PKDR);
|
|
}
|
|
|
|
static void hp6xxled_red_set(struct led_classdev *led_cdev,
|
|
enum led_brightness value)
|
|
{
|
|
u16 v16;
|
|
|
|
v16 = inw(HD64461_GPBDR);
|
|
if (value)
|
|
outw(v16 & (~HD64461_GPBDR_LED_RED), HD64461_GPBDR);
|
|
else
|
|
outw(v16 | HD64461_GPBDR_LED_RED, HD64461_GPBDR);
|
|
}
|
|
|
|
static struct led_classdev hp6xx_red_led = {
|
|
.name = "hp6xx:red",
|
|
.default_trigger = "hp6xx-charge",
|
|
.brightness_set = hp6xxled_red_set,
|
|
.flags = LED_CORE_SUSPENDRESUME,
|
|
};
|
|
|
|
static struct led_classdev hp6xx_green_led = {
|
|
.name = "hp6xx:green",
|
|
.default_trigger = "ide-disk",
|
|
.brightness_set = hp6xxled_green_set,
|
|
.flags = LED_CORE_SUSPENDRESUME,
|
|
};
|
|
|
|
static int hp6xxled_probe(struct platform_device *pdev)
|
|
{
|
|
int ret;
|
|
|
|
ret = led_classdev_register(&pdev->dev, &hp6xx_red_led);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = led_classdev_register(&pdev->dev, &hp6xx_green_led);
|
|
if (ret < 0)
|
|
led_classdev_unregister(&hp6xx_red_led);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int hp6xxled_remove(struct platform_device *pdev)
|
|
{
|
|
led_classdev_unregister(&hp6xx_red_led);
|
|
led_classdev_unregister(&hp6xx_green_led);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* work with hotplug and coldplug */
|
|
MODULE_ALIAS("platform:hp6xx-led");
|
|
|
|
static struct platform_driver hp6xxled_driver = {
|
|
.probe = hp6xxled_probe,
|
|
.remove = hp6xxled_remove,
|
|
.driver = {
|
|
.name = "hp6xx-led",
|
|
.owner = THIS_MODULE,
|
|
},
|
|
};
|
|
|
|
static int __init hp6xxled_init(void)
|
|
{
|
|
return platform_driver_register(&hp6xxled_driver);
|
|
}
|
|
|
|
static void __exit hp6xxled_exit(void)
|
|
{
|
|
platform_driver_unregister(&hp6xxled_driver);
|
|
}
|
|
|
|
module_init(hp6xxled_init);
|
|
module_exit(hp6xxled_exit);
|
|
|
|
MODULE_AUTHOR("Kristoffer Ericson <kristoffer.ericson@gmail.com>");
|
|
MODULE_DESCRIPTION("HP Jornada 6xx LED driver");
|
|
MODULE_LICENSE("GPL");
|