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/module.h> 14 #include <linux/kernel.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 = "disk-activity", 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 = devm_led_classdev_register(&pdev->dev, &hp6xx_red_led); 63 if (ret < 0) 64 return ret; 65 66 return devm_led_classdev_register(&pdev->dev, &hp6xx_green_led); 67 } 68 69 static struct platform_driver hp6xxled_driver = { 70 .probe = hp6xxled_probe, 71 .driver = { 72 .name = "hp6xx-led", 73 }, 74 }; 75 76 module_platform_driver(hp6xxled_driver); 77 78 MODULE_AUTHOR("Kristoffer Ericson <kristoffer.ericson@gmail.com>"); 79 MODULE_DESCRIPTION("HP Jornada 6xx LED driver"); 80 MODULE_LICENSE("GPL"); 81 MODULE_ALIAS("platform:hp6xx-led"); 82