0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011 #include <linux/kernel.h>
0012 #include <linux/platform_device.h>
0013 #include <linux/leds.h>
0014 #include <linux/gpio/consumer.h>
0015 #include <linux/slab.h>
0016 #include <linux/module.h>
0017 #include <linux/platform_data/leds-s3c24xx.h>
0018
0019
0020
0021 struct s3c24xx_gpio_led {
0022 struct led_classdev cdev;
0023 struct s3c24xx_led_platdata *pdata;
0024 struct gpio_desc *gpiod;
0025 };
0026
0027 static inline struct s3c24xx_gpio_led *to_gpio(struct led_classdev *led_cdev)
0028 {
0029 return container_of(led_cdev, struct s3c24xx_gpio_led, cdev);
0030 }
0031
0032 static void s3c24xx_led_set(struct led_classdev *led_cdev,
0033 enum led_brightness value)
0034 {
0035 struct s3c24xx_gpio_led *led = to_gpio(led_cdev);
0036
0037 gpiod_set_value(led->gpiod, !!value);
0038 }
0039
0040 static int s3c24xx_led_probe(struct platform_device *dev)
0041 {
0042 struct s3c24xx_led_platdata *pdata = dev_get_platdata(&dev->dev);
0043 struct s3c24xx_gpio_led *led;
0044 int ret;
0045
0046 led = devm_kzalloc(&dev->dev, sizeof(struct s3c24xx_gpio_led),
0047 GFP_KERNEL);
0048 if (!led)
0049 return -ENOMEM;
0050
0051 led->cdev.brightness_set = s3c24xx_led_set;
0052 led->cdev.default_trigger = pdata->def_trigger;
0053 led->cdev.name = pdata->name;
0054 led->cdev.flags |= LED_CORE_SUSPENDRESUME;
0055
0056 led->pdata = pdata;
0057
0058
0059 led->gpiod = devm_gpiod_get(&dev->dev, NULL, GPIOD_OUT_LOW);
0060 if (IS_ERR(led->gpiod))
0061 return PTR_ERR(led->gpiod);
0062
0063
0064 ret = devm_led_classdev_register(&dev->dev, &led->cdev);
0065 if (ret < 0)
0066 dev_err(&dev->dev, "led_classdev_register failed\n");
0067
0068 return ret;
0069 }
0070
0071 static struct platform_driver s3c24xx_led_driver = {
0072 .probe = s3c24xx_led_probe,
0073 .driver = {
0074 .name = "s3c24xx_led",
0075 },
0076 };
0077
0078 module_platform_driver(s3c24xx_led_driver);
0079
0080 MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
0081 MODULE_DESCRIPTION("S3C24XX LED driver");
0082 MODULE_LICENSE("GPL");
0083 MODULE_ALIAS("platform:s3c24xx_led");