1/* 2 * LEDs driver for Amstrad Delta (E3) 3 * 4 * Copyright (C) 2006 Jonathan McDowell <noodles@earth.li> 5 * 6 * This program is free software; you can redistribute it and/or modify 7 * it under the terms of the GNU General Public License version 2 as 8 * published by the Free Software Foundation. 9 */ 10 11#include <linux/kernel.h> 12#include <linux/init.h> 13#include <linux/platform_device.h> 14#include <linux/leds.h> 15#include <plat/board-ams-delta.h> 16 17/* 18 * Our context 19 */ 20struct ams_delta_led { 21 struct led_classdev cdev; 22 u8 bitmask; 23}; 24 25static void ams_delta_led_set(struct led_classdev *led_cdev, 26 enum led_brightness value) 27{ 28 struct ams_delta_led *led_dev = 29 container_of(led_cdev, struct ams_delta_led, cdev); 30 31 if (value) 32 ams_delta_latch1_write(led_dev->bitmask, led_dev->bitmask); 33 else 34 ams_delta_latch1_write(led_dev->bitmask, 0); 35} 36 37static struct ams_delta_led ams_delta_leds[] = { 38 { 39 .cdev = { 40 .name = "ams-delta::camera", 41 .brightness_set = ams_delta_led_set, 42 }, 43 .bitmask = AMS_DELTA_LATCH1_LED_CAMERA, 44 }, 45 { 46 .cdev = { 47 .name = "ams-delta::advert", 48 .brightness_set = ams_delta_led_set, 49 }, 50 .bitmask = AMS_DELTA_LATCH1_LED_ADVERT, 51 }, 52 { 53 .cdev = { 54 .name = "ams-delta::email", 55 .brightness_set = ams_delta_led_set, 56 }, 57 .bitmask = AMS_DELTA_LATCH1_LED_EMAIL, 58 }, 59 { 60 .cdev = { 61 .name = "ams-delta::handsfree", 62 .brightness_set = ams_delta_led_set, 63 }, 64 .bitmask = AMS_DELTA_LATCH1_LED_HANDSFREE, 65 }, 66 { 67 .cdev = { 68 .name = "ams-delta::voicemail", 69 .brightness_set = ams_delta_led_set, 70 }, 71 .bitmask = AMS_DELTA_LATCH1_LED_VOICEMAIL, 72 }, 73 { 74 .cdev = { 75 .name = "ams-delta::voice", 76 .brightness_set = ams_delta_led_set, 77 }, 78 .bitmask = AMS_DELTA_LATCH1_LED_VOICE, 79 }, 80}; 81 82static int ams_delta_led_probe(struct platform_device *pdev) 83{ 84 int i, ret; 85 86 for (i = 0; i < ARRAY_SIZE(ams_delta_leds); i++) { 87 ams_delta_leds[i].cdev.flags |= LED_CORE_SUSPENDRESUME; 88 ret = led_classdev_register(&pdev->dev, 89 &ams_delta_leds[i].cdev); 90 if (ret < 0) 91 goto fail; 92 } 93 94 return 0; 95fail: 96 while (--i >= 0) 97 led_classdev_unregister(&ams_delta_leds[i].cdev); 98 return ret; 99} 100 101static int ams_delta_led_remove(struct platform_device *pdev) 102{ 103 int i; 104 105 for (i = 0; i < ARRAY_SIZE(ams_delta_leds); i++) 106 led_classdev_unregister(&ams_delta_leds[i].cdev); 107 108 return 0; 109} 110 111static struct platform_driver ams_delta_led_driver = { 112 .probe = ams_delta_led_probe, 113 .remove = ams_delta_led_remove, 114 .driver = { 115 .name = "ams-delta-led", 116 .owner = THIS_MODULE, 117 }, 118}; 119 120static int __init ams_delta_led_init(void) 121{ 122 return platform_driver_register(&ams_delta_led_driver); 123} 124 125static void __exit ams_delta_led_exit(void) 126{ 127 platform_driver_unregister(&ams_delta_led_driver); 128} 129 130module_init(ams_delta_led_init); 131module_exit(ams_delta_led_exit); 132 133MODULE_AUTHOR("Jonathan McDowell <noodles@earth.li>"); 134MODULE_DESCRIPTION("Amstrad Delta LED driver"); 135MODULE_LICENSE("GPL"); 136MODULE_ALIAS("platform:ams-delta-led"); 137