drivers/leds/leds-omap.c

   1 /* drivers/leds/leds-omap.c
   2  *
   3  * (C) 2006 Samsung Electronics
   4  * Kyungmin Park <kyungmin.park@samsung.com>
   5  *
   6  * OMAP - LEDs GPIO driver
   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/kernel.h>
  14 #include <linux/init.h>
  15 #include <linux/platform_device.h>
  16 #include <linux/leds.h>
  17 #include <linux/gpio.h>
  18
  19 #include <mach/hardware.h>
  20 #include <mach/led.h>
  21
  22 /* our context */
  23
  24 static void omap_set_led_gpio(struct led_classdev *led_cdev,
  25                             enum led_brightness value)
  26 {
  27         struct omap_led_config *led_dev;
  28
  29         led_dev = container_of(led_cdev, struct omap_led_config, cdev);
  30         gpio_set_value(led_dev->gpio, value);
  31 }
  32
  33 static int omap_led_probe(struct platform_device *dev)
  34 {
  35         struct omap_led_platform_data *pdata = dev->dev.platform_data;
  36         struct omap_led_config *leds = pdata->leds;
  37         int i, ret = 0;
  38
  39         for (i = 0; ret >= 0 && i < pdata->nr_leds; i++) {
  40                 ret = gpio_request(leds[i].gpio, leds[i].cdev.name);
  41                 if (ret < 0)
  42                         break;
  43                 gpio_direction_output(leds[i].gpio, 0);
  44                 if (!leds[i].cdev.brightness_set)
  45                         leds[i].cdev.brightness_set = omap_set_led_gpio;
  46
  47                 ret = led_classdev_register(&dev->dev, &leds[i].cdev);
  48         }
  49
  50         if (ret < 0 && i > 1) {
  51                 for (i = i - 2; i >= 0; i--) {
  52                         led_classdev_unregister(&leds[i].cdev);
  53                         gpio_free(leds[i].gpio);
  54                 }
  55         }
  56
  57         return ret;
  58 }
  59
  60 static int omap_led_remove(struct platform_device *dev)
  61 {
  62         struct omap_led_platform_data *pdata = dev->dev.platform_data;
  63         struct omap_led_config *leds = pdata->leds;
  64         int i;
  65
  66         for (i = 0; i < pdata->nr_leds; i++) {
  67                 led_classdev_unregister(&leds[i].cdev);
  68                 gpio_free(leds[i].gpio);
  69         }
  70
  71         return 0;
  72 }
  73
  74 #ifdef CONFIG_PM
  75 static int omap_led_suspend(struct platform_device *dev, pm_message_t state)
  76 {
  77         struct omap_led_platform_data *pdata = dev->dev.platform_data;
  78         struct omap_led_config *leds = pdata->leds;
  79         int i;
  80
  81         for (i = 0; i < pdata->nr_leds; i++)
  82                 led_classdev_suspend(&leds[i].cdev);
  83
  84         return 0;
  85 }
  86
  87 static int omap_led_resume(struct platform_device *dev)
  88 {
  89         struct omap_led_platform_data *pdata = dev->dev.platform_data;
  90         struct omap_led_config *leds = pdata->leds;
  91         int i;
  92
  93         for (i = 0; i < pdata->nr_leds; i++)
  94                 led_classdev_resume(&leds[i].cdev);
  95
  96         return 0;
  97 }
  98 #else
  99 #define omap_led_suspend        NULL
 100 #define omap_led_resume         NULL
 101 #endif
 102
 103 static struct platform_driver omap_led_driver = {
 104         .probe          = omap_led_probe,
 105         .remove         = omap_led_remove,
 106         .suspend        = omap_led_suspend,
 107         .resume         = omap_led_resume,
 108         .driver         = {
 109                 .name           = "omap-led",
 110                 .owner          = THIS_MODULE,
 111         },
 112 };
 113
 114 static int __init omap_led_init(void)
 115 {
 116         return platform_driver_register(&omap_led_driver);
 117 }
 118
 119 static void __exit omap_led_exit(void)
 120 {
 121         platform_driver_unregister(&omap_led_driver);
 122 }
 123
 124 module_init(omap_led_init);
 125 module_exit(omap_led_exit);
 126
 127 MODULE_AUTHOR("Kyungmin Park<kyungmin.park@samsung.com>");
 128 MODULE_DESCRIPTION("OMAP LED driver");
 129 MODULE_LICENSE("GPL");