2006-06-23 13:05:33 +04:00
/*
* 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>
2008-08-05 19:14:15 +04:00
# include <mach/board-ams-delta.h>
2006-06-23 13:05:33 +04:00
/*
* 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 = {
2007-10-31 17:00:07 +03:00
. name = " ams-delta::camera " ,
2006-06-23 13:05:33 +04:00
. brightness_set = ams_delta_led_set ,
} ,
. bitmask = AMS_DELTA_LATCH1_LED_CAMERA ,
} ,
{
. cdev = {
2007-10-31 17:00:07 +03:00
. name = " ams-delta::advert " ,
2006-06-23 13:05:33 +04:00
. brightness_set = ams_delta_led_set ,
} ,
. bitmask = AMS_DELTA_LATCH1_LED_ADVERT ,
} ,
{
. cdev = {
2007-10-31 17:00:07 +03:00
. name = " ams-delta::email " ,
2006-06-23 13:05:33 +04:00
. brightness_set = ams_delta_led_set ,
} ,
. bitmask = AMS_DELTA_LATCH1_LED_EMAIL ,
} ,
{
. cdev = {
2007-10-31 17:00:07 +03:00
. name = " ams-delta::handsfree " ,
2006-06-23 13:05:33 +04:00
. brightness_set = ams_delta_led_set ,
} ,
. bitmask = AMS_DELTA_LATCH1_LED_HANDSFREE ,
} ,
{
. cdev = {
2007-10-31 17:00:07 +03:00
. name = " ams-delta::voicemail " ,
2006-06-23 13:05:33 +04:00
. brightness_set = ams_delta_led_set ,
} ,
. bitmask = AMS_DELTA_LATCH1_LED_VOICEMAIL ,
} ,
{
. cdev = {
2007-10-31 17:00:07 +03:00
. name = " ams-delta::voice " ,
2006-06-23 13:05:33 +04:00
. 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 " ,
2008-04-16 01:34:30 +04:00
. owner = THIS_MODULE ,
2006-06-23 13:05:33 +04:00
} ,
} ;
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 " ) ;
2008-04-16 01:34:30 +04:00
MODULE_ALIAS ( " platform:ams-delta-led " ) ;