arch/mips/mti-sead3/leds-sead3.c

   1 /*
   2  * This file is subject to the terms and conditions of the GNU General Public
   3  * License.  See the file "COPYING" in the main directory of this archive
   4  * for more details.
   5  *
   6  * Copyright (C) 2012 MIPS Technologies, Inc.  All rights reserved.
   7  */
   8 #include <linux/kernel.h>
   9 #include <linux/module.h>
  10 #include <linux/init.h>
  11 #include <linux/platform_device.h>
  12 #include <linux/leds.h>
  13 #include <linux/err.h>
  14 #include <linux/io.h>
  15
  16 #define DRVNAME "sead3-led"
  17
  18 static void sead3_pled_set(struct led_classdev *led_cdev,
  19                 enum led_brightness value)
  20 {
  21         writel(value, (void __iomem *)0xBF000210);      /* FIXME */
  22 }
  23
  24 static void sead3_fled_set(struct led_classdev *led_cdev,
  25                 enum led_brightness value)
  26 {
  27         writel(value, (void __iomem *)0xBF000218);      /* FIXME */
  28 }
  29
  30 static struct led_classdev sead3_pled = {
  31         .name           = "sead3::pled",
  32         .brightness_set = sead3_pled_set,
  33         .flags          = LED_CORE_SUSPENDRESUME,
  34 };
  35
  36 static struct led_classdev sead3_fled = {
  37         .name           = "sead3::fled",
  38         .brightness_set = sead3_fled_set,
  39         .flags          = LED_CORE_SUSPENDRESUME,
  40 };
  41
  42 static int sead3_led_probe(struct platform_device *pdev)
  43 {
  44         int ret;
  45
  46         ret = led_classdev_register(&pdev->dev, &sead3_pled);
  47         if (ret < 0)
  48                 return ret;
  49
  50         ret = led_classdev_register(&pdev->dev, &sead3_fled);
  51         if (ret < 0)
  52                 led_classdev_unregister(&sead3_pled);
  53
  54         return ret;
  55 }
  56
  57 static int sead3_led_remove(struct platform_device *pdev)
  58 {
  59         led_classdev_unregister(&sead3_pled);
  60         led_classdev_unregister(&sead3_fled);
  61         return 0;
  62 }
  63
  64 static struct platform_driver sead3_led_driver = {
  65         .probe          = sead3_led_probe,
  66         .remove         = sead3_led_remove,
  67         .driver         = {
  68                 .name           = DRVNAME,
  69         },
  70 };
  71
  72 module_platform_driver(sead3_led_driver);
  73
  74 MODULE_AUTHOR("Kristian Kielhofner <kris@krisk.org>");
  75 MODULE_DESCRIPTION("SEAD3 LED driver");
  76 MODULE_LICENSE("GPL");