target/linux/lantiq/files-3.3/arch/mips/lantiq/falcon/dev-leds-easy98000-cpld.c

   1 /*
   2  *  EASY98000 CPLD LED driver
   3  *
   4  *  Copyright (C) 2010 Ralph Hempel <ralph.hempel@lantiq.com>
   5  *
   6  *  This program is free software; you can redistribute it and/or modify it
   7  *  under the terms of the GNU General Public License version 2  as published
   8  *  by the Free Software Foundation.
   9  *
  10  */
  11
  12 #include <linux/kernel.h>
  13 #include <linux/version.h>
  14 #include <linux/types.h>
  15 #include <linux/init.h>
  16 #include <linux/platform_device.h>
  17 #include <linux/module.h>
  18 #include <linux/errno.h>
  19 #include <linux/leds.h>
  20 #include <linux/slab.h>
  21
  22 #include "dev-leds-easy98000-cpld.h"
  23
  24 const char *led_name[8] = {
  25         "ge0_act",
  26         "ge0_link",
  27         "ge1_act",
  28         "ge1_link",
  29         "fe2_act",
  30         "fe2_link",
  31         "fe3_act",
  32         "fe3_link"
  33 };
  34
  35 #define cpld_base7                      ((u16 *)(KSEG1 | 0x17c0000c))
  36 #define cpld_base8                      ((u16 *)(KSEG1 | 0x17c00012))
  37
  38 #define ltq_r16(reg)                    __raw_readw(reg)
  39 #define ltq_w16(val, reg)               __raw_writew(val, reg)
  40
  41 struct cpld_led_dev {
  42         struct led_classdev     cdev;
  43         u8                      mask;
  44         u16                     *base;
  45 };
  46
  47 struct cpld_led_drvdata {
  48         struct cpld_led_dev     *led_devs;
  49         int                     num_leds;
  50 };
  51
  52 void led_set(u8 mask, u16 *base)
  53 {
  54         ltq_w16(ltq_r16(base) | mask, base);
  55 }
  56
  57 void led_clear(u8 mask, u16 *base)
  58 {
  59         ltq_w16(ltq_r16(base) & (~mask), base);
  60 }
  61
  62 void led_blink_clear(u8 mask, u16 *base)
  63 {
  64         led_clear(mask, base);
  65 }
  66
  67 static void led_brightness(struct led_classdev *led_cdev,
  68                                enum led_brightness value)
  69 {
  70         struct cpld_led_dev *led_dev =
  71             container_of(led_cdev, struct cpld_led_dev, cdev);
  72
  73         if (value)
  74                 led_set(led_dev->mask, led_dev->base);
  75         else
  76                 led_clear(led_dev->mask, led_dev->base);
  77 }
  78
  79 static int led_probe(struct platform_device *pdev)
  80 {
  81         int i;
  82         char name[32];
  83         struct cpld_led_drvdata *drvdata;
  84         int ret = 0;
  85
  86         drvdata = kzalloc(sizeof(struct cpld_led_drvdata) +
  87                           sizeof(struct cpld_led_dev) * MAX_LED,
  88                           GFP_KERNEL);
  89         if (!drvdata)
  90                 return -ENOMEM;
  91
  92         drvdata->led_devs = (struct cpld_led_dev *) &drvdata[1];
  93
  94         for (i = 0; i < MAX_LED; i++) {
  95                 struct cpld_led_dev *led_dev = &drvdata->led_devs[i];
  96                 led_dev->cdev.brightness_set = led_brightness;
  97                 led_dev->cdev.default_trigger = NULL;
  98                 led_dev->mask = 1 << (i % 8);
  99                 if(i < 8) {
 100                         sprintf(name, "easy98000-cpld:%s", led_name[i]);
 101                         led_dev->base = cpld_base8;
 102                 } else {
 103                         sprintf(name, "easy98000-cpld:red:%d", i-8);
 104                         led_dev->base = cpld_base7;
 105                 }
 106                 led_dev->cdev.name = name;
 107                 ret = led_classdev_register(&pdev->dev, &led_dev->cdev);
 108                 if (ret)
 109                         goto err;
 110         }
 111         platform_set_drvdata(pdev, drvdata);
 112         return 0;
 113
 114 err:
 115         printk("led_probe: 3\n");
 116         for (i = i - 1; i >= 0; i--)
 117                 led_classdev_unregister(&drvdata->led_devs[i].cdev);
 118
 119         kfree(drvdata);
 120         return ret;
 121 }
 122
 123 static int led_remove(struct platform_device *pdev)
 124 {
 125         int i;
 126         struct cpld_led_drvdata *drvdata = platform_get_drvdata(pdev);
 127         for (i = 0; i < MAX_LED; i++)
 128                 led_classdev_unregister(&drvdata->led_devs[i].cdev);
 129         kfree(drvdata);
 130         return 0;
 131 }
 132
 133 static struct platform_driver led_driver = {
 134         .probe = led_probe,
 135         .remove = __devexit_p(led_remove),
 136         .driver = {
 137                    .name = LED_NAME,
 138                    .owner = THIS_MODULE,
 139                    },
 140 };
 141
 142 int __init easy98000_cpld_led_init(void)
 143 {
 144         pr_info(LED_DESC ", Version " LED_VERSION
 145                 " (c) Copyright 2011, Lantiq Deutschland GmbH\n");
 146         return platform_driver_register(&led_driver);
 147 }
 148
 149 void __exit easy98000_cpld_led_exit(void)
 150 {
 151         platform_driver_unregister(&led_driver);
 152 }
 153
 154 module_init(easy98000_cpld_led_init);
 155 module_exit(easy98000_cpld_led_exit);
 156
 157 MODULE_DESCRIPTION(LED_NAME);
 158 MODULE_DESCRIPTION(LED_DESC);
 159 MODULE_AUTHOR("Ralph Hempel <ralph.hempel@lantiq.com>");
 160 MODULE_LICENSE("GPL v2");
 161