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 20 static 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 32 static 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 44 static 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 51 static 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 58 static 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 73 static 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 */ 82 MODULE_ALIAS("platform:hp6xx-led"); 83 84 static 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 93 static int __init hp6xxled_init(void) 94 { 95 return platform_driver_register(&hp6xxled_driver); 96 } 97 98 static void __exit hp6xxled_exit(void) 99 { 100 platform_driver_unregister(&hp6xxled_driver); 101 } 102 103 module_init(hp6xxled_init); 104 module_exit(hp6xxled_exit); 105 106 MODULE_AUTHOR("Kristoffer Ericson <kristoffer.ericson@gmail.com>"); 107 MODULE_DESCRIPTION("HP Jornada 6xx LED driver"); 108 MODULE_LICENSE("GPL"); 109