/* * LEDs driver for Amstrad Delta (E3) * * Copyright (C) 2006 Jonathan McDowell <noodles@earth.li> * * 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 <mach/board-ams-delta.h> /* * Our context */ struct ams_delta_led { struct led_classdev cdev; u8 bitmask; }; static void ams_delta_led_set(struct led_classdev *led_cdev, enum led_brightness value) { struct ams_delta_led *led_dev = container_of(led_cdev, struct ams_delta_led, cdev); if (value) ams_delta_latch1_write(led_dev->bitmask, led_dev->bitmask); else ams_delta_latch1_write(led_dev->bitmask, 0); } static struct ams_delta_led ams_delta_leds[] = { { .cdev = { .name = "ams-delta::camera", .brightness_set = ams_delta_led_set, }, .bitmask = AMS_DELTA_LATCH1_LED_CAMERA, }, { .cdev = { .name = "ams-delta::advert", .brightness_set = ams_delta_led_set, }, .bitmask = AMS_DELTA_LATCH1_LED_ADVERT, }, { .cdev = { .name = "ams-delta::email", .brightness_set = ams_delta_led_set, }, .bitmask = AMS_DELTA_LATCH1_LED_EMAIL, }, { .cdev = { .name = "ams-delta::handsfree", .brightness_set = ams_delta_led_set, }, .bitmask = AMS_DELTA_LATCH1_LED_HANDSFREE, }, { .cdev = { .name = "ams-delta::voicemail", .brightness_set = ams_delta_led_set, }, .bitmask = AMS_DELTA_LATCH1_LED_VOICEMAIL, }, { .cdev = { .name = "ams-delta::voice", .brightness_set = ams_delta_led_set, }, .bitmask = AMS_DELTA_LATCH1_LED_VOICE, }, }; #ifdef CONFIG_PM static int ams_delta_led_suspend(struct platform_device *dev, pm_message_t state) { int i; for (i = 0; i < ARRAY_SIZE(ams_delta_leds); i++) led_classdev_suspend(&ams_delta_leds[i].cdev); return 0; } static int ams_delta_led_resume(struct platform_device *dev) { int i; for (i = 0; i < ARRAY_SIZE(ams_delta_leds); i++) led_classdev_resume(&ams_delta_leds[i].cdev); return 0; } #else #define ams_delta_led_suspend NULL #define ams_delta_led_resume NULL #endif static int ams_delta_led_probe(struct platform_device *pdev) { int i; int ret; for (i = ret = 0; ret >= 0 && i < ARRAY_SIZE(ams_delta_leds); i++) { ret = led_classdev_register(&pdev->dev, &ams_delta_leds[i].cdev); } if (ret < 0 && i > 1) { for (i = i - 2; i >= 0; i--) led_classdev_unregister(&ams_delta_leds[i].cdev); } return ret; } static int ams_delta_led_remove(struct platform_device *pdev) { int i; for (i = ARRAY_SIZE(ams_delta_leds) - 1; i >= 0; i--) led_classdev_unregister(&ams_delta_leds[i].cdev); return 0; } static struct platform_driver ams_delta_led_driver = { .probe = ams_delta_led_probe, .remove = ams_delta_led_remove, .suspend = ams_delta_led_suspend, .resume = ams_delta_led_resume, .driver = { .name = "ams-delta-led", .owner = THIS_MODULE, }, }; static int __init ams_delta_led_init(void) { return platform_driver_register(&ams_delta_led_driver); } static void __exit ams_delta_led_exit(void) { return platform_driver_unregister(&ams_delta_led_driver); } module_init(ams_delta_led_init); module_exit(ams_delta_led_exit); MODULE_AUTHOR("Jonathan McDowell <noodles@earth.li>"); MODULE_DESCRIPTION("Amstrad Delta LED driver"); MODULE_LICENSE("GPL"); MODULE_ALIAS("platform:ams-delta-led");