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
  18 #include <mach/gpio.h>
  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
  31         if (value)
  32                 omap_set_gpio_dataout(led_dev->gpio, 1);
  33         else
  34                 omap_set_gpio_dataout(led_dev->gpio, 0);
  35 }
  36
  37 static void omap_configure_led_gpio(int gpio)
  38 {
  39         if (omap_request_gpio(gpio) < 0) {
  40                 printk(KERN_ERR "Failed to request GPIO%d for LEDs\n", gpio);
  41                 return;
  42         }
  43         omap_set_gpio_direction(gpio, 0);       /* OUT */
  44 }
  45
  46 static int omap_led_probe(struct platform_device *dev)
  47 {
  48         struct omap_led_platform_data *pdata = dev->dev.platform_data;
  49         struct omap_led_config *leds = pdata->leds;
  50         int i, ret = 0;
  51
  52         for (i = 0; ret >= 0 && i < pdata->nr_leds; i++) {
  53                 omap_configure_led_gpio(leds[i].gpio);
  54                 if (!leds[i].cdev.brightness_set)
  55                         leds[i].cdev.brightness_set = omap_set_led_gpio;
  56
  57                 ret = led_classdev_register(&dev->dev, &leds[i].cdev);
  58         }
  59
  60         if (ret < 0 && i > 1) {
  61                 for (i = i - 2; i >= 0; i--)
  62                         led_classdev_unregister(&leds[i].cdev);
  63         }
  64
  65         return ret;
  66 }
  67
  68 static int omap_led_remove(struct platform_device *dev)
  69 {
  70         struct omap_led_platform_data *pdata = dev->dev.platform_data;
  71         struct omap_led_config *leds = pdata->leds;
  72         int i;
  73
  74         for (i = 0; i < pdata->nr_leds; i++)
  75                 led_classdev_unregister(&leds[i].cdev);
  76
  77         return 0;
  78 }
  79
  80 #ifdef CONFIG_PM
  81 static int omap_led_suspend(struct platform_device *dev, pm_message_t state)
  82 {
  83         struct omap_led_platform_data *pdata = dev->dev.platform_data;
  84         struct omap_led_config *leds = pdata->leds;
  85         int i;
  86
  87         for (i = 0; i < pdata->nr_leds; i++)
  88                 led_classdev_suspend(&leds[i].cdev);
  89
  90         return 0;
  91 }
  92
  93 static int omap_led_resume(struct platform_device *dev)
  94 {
  95         struct omap_led_platform_data *pdata = dev->dev.platform_data;
  96         struct omap_led_config *leds = pdata->leds;
  97         int i;
  98
  99         for (i = 0; i < pdata->nr_leds; i++)
 100                 led_classdev_resume(&leds[i].cdev);
 101
 102         return 0;
 103 }
 104 #else
 105 #define omap_led_suspend        NULL
 106 #define omap_led_resume         NULL
 107 #endif
 108
 109 static struct platform_driver omap_led_driver = {
 110         .probe          = omap_led_probe,
 111         .remove         = omap_led_remove,
 112         .suspend        = omap_led_suspend,
 113         .resume         = omap_led_resume,
 114         .driver         = {
 115                 .name           = "omap-led",
 116                 .owner          = THIS_MODULE,
 117         },
 118 };
 119
 120 static int __init omap_led_init(void)
 121 {
 122         return platform_driver_register(&omap_led_driver);
 123 }
 124
 125 static void __exit omap_led_exit(void)
 126 {
 127         platform_driver_unregister(&omap_led_driver);
 128 }
 129
 130 module_init(omap_led_init);
 131 module_exit(omap_led_exit);
 132
 133 MODULE_AUTHOR("Kyungmin Park<kyungmin.park@samsung.com>");
 134 MODULE_DESCRIPTION("OMAP LED driver");
 135 MODULE_LICENSE("GPL");