1/* 2 * LED Triggers Core 3 * For the HP Jornada 620/660/680/690 handhelds 4 * 5 * Copyright 2008 Kristoffer Ericson <kristoffer.ericson@gmail.com> 6 * this driver is based on leds-spitz.c by Richard Purdie. 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#include <linux/kernel.h> 14#include <linux/init.h> 15#include <linux/platform_device.h> 16#include <linux/leds.h> 17#include <asm/hd64461.h> 18#include <mach/hp6xx.h> 19 20static void hp6xxled_green_set(struct led_classdev *led_cdev, 21 enum led_brightness value) 22{ 23 u8 v8; 24 25 v8 = inb(PKDR); 26 if (value) 27 outb(v8 & (~PKDR_LED_GREEN), PKDR); 28 else 29 outb(v8 | PKDR_LED_GREEN, PKDR); 30} 31 32static void hp6xxled_red_set(struct led_classdev *led_cdev, 33 enum led_brightness value) 34{ 35 u16 v16; 36 37 v16 = inw(HD64461_GPBDR); 38 if (value) 39 outw(v16 & (~HD64461_GPBDR_LED_RED), HD64461_GPBDR); 40 else 41 outw(v16 | HD64461_GPBDR_LED_RED, HD64461_GPBDR); 42} 43 44static struct led_classdev hp6xx_red_led = { 45 .name = "hp6xx:red", 46 .default_trigger = "hp6xx-charge", 47 .brightness_set = hp6xxled_red_set, 48 .flags = LED_CORE_SUSPENDRESUME, 49}; 50 51static struct led_classdev hp6xx_green_led = { 52 .name = "hp6xx:green", 53 .default_trigger = "ide-disk", 54 .brightness_set = hp6xxled_green_set, 55 .flags = LED_CORE_SUSPENDRESUME, 56}; 57 58static int hp6xxled_probe(struct platform_device *pdev) 59{ 60 int ret; 61 62 ret = led_classdev_register(&pdev->dev, &hp6xx_red_led); 63 if (ret < 0) 64 return ret; 65 66 ret = led_classdev_register(&pdev->dev, &hp6xx_green_led); 67 if (ret < 0) 68 led_classdev_unregister(&hp6xx_red_led); 69 70 return ret; 71} 72 73static int hp6xxled_remove(struct platform_device *pdev) 74{ 75 led_classdev_unregister(&hp6xx_red_led); 76 led_classdev_unregister(&hp6xx_green_led); 77 78 return 0; 79} 80 81/* work with hotplug and coldplug */ 82MODULE_ALIAS("platform:hp6xx-led"); 83 84static struct platform_driver hp6xxled_driver = { 85 .probe = hp6xxled_probe, 86 .remove = hp6xxled_remove, 87 .driver = { 88 .name = "hp6xx-led", 89 .owner = THIS_MODULE, 90 }, 91}; 92 93static int __init hp6xxled_init(void) 94{ 95 return platform_driver_register(&hp6xxled_driver); 96} 97 98static void __exit hp6xxled_exit(void) 99{ 100 platform_driver_unregister(&hp6xxled_driver); 101} 102 103module_init(hp6xxled_init); 104module_exit(hp6xxled_exit); 105 106MODULE_AUTHOR("Kristoffer Ericson <kristoffer.ericson@gmail.com>"); 107MODULE_DESCRIPTION("HP Jornada 6xx LED driver"); 108MODULE_LICENSE("GPL"); 109