drivers/leds/leds-88pm860x.c

   1 /*
   2  * LED driver for Marvell 88PM860x
   3  *
   4  * Copyright (C) 2009 Marvell International Ltd.
   5  *      Haojian Zhuang <haojian.zhuang@marvell.com>
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License version 2 as
   9  * published by the Free Software Foundation.
  10  *
  11  */
  12
  13 #include <linux/kernel.h>
  14 #include <linux/init.h>
  15 #include <linux/platform_device.h>
  16 #include <linux/i2c.h>
  17 #include <linux/leds.h>
  18 #include <linux/slab.h>
  19 #include <linux/workqueue.h>
  20 #include <linux/mfd/88pm860x.h>
  21 #include <linux/module.h>
  22
  23 #define LED_PWM_SHIFT           (3)
  24 #define LED_PWM_MASK            (0x1F)
  25 #define LED_CURRENT_MASK        (0x07 << 5)
  26
  27 #define LED_BLINK_ON_MASK       (0x07)
  28 #define LED_BLINK_MASK          (0x7F)
  29
  30 #define LED_BLINK_ON(x)         ((x & 0x7) * 66 + 66)
  31 #define LED_BLINK_ON_MIN        LED_BLINK_ON(0)
  32 #define LED_BLINK_ON_MAX        LED_BLINK_ON(0x7)
  33 #define LED_ON_CONTINUOUS       (0x0F << 3)
  34 #define LED_TO_ON(x)            ((x - 66) / 66)
  35
  36 #define LED1_BLINK_EN           (1 << 1)
  37 #define LED2_BLINK_EN           (1 << 2)
  38
  39 struct pm860x_led {
  40         struct led_classdev cdev;
  41         struct i2c_client *i2c;
  42         struct work_struct work;
  43         struct pm860x_chip *chip;
  44         struct mutex lock;
  45         char name[MFD_NAME_SIZE];
  46
  47         int port;
  48         int iset;
  49         unsigned char brightness;
  50         unsigned char current_brightness;
  51
  52         int blink_data;
  53         int blink_time;
  54         int blink_on;
  55         int blink_off;
  56 };
  57
  58 /* return offset of color register */
  59 static inline int __led_off(int port)
  60 {
  61         int ret = -EINVAL;
  62
  63         switch (port) {
  64         case PM8606_LED1_RED:
  65         case PM8606_LED1_GREEN:
  66         case PM8606_LED1_BLUE:
  67                 ret = port - PM8606_LED1_RED + PM8606_RGB1B;
  68                 break;
  69         case PM8606_LED2_RED:
  70         case PM8606_LED2_GREEN:
  71         case PM8606_LED2_BLUE:
  72                 ret = port - PM8606_LED2_RED + PM8606_RGB2B;
  73                 break;
  74         }
  75         return ret;
  76 }
  77
  78 /* return offset of blink register */
  79 static inline int __blink_off(int port)
  80 {
  81         int ret = -EINVAL;
  82
  83         switch (port) {
  84         case PM8606_LED1_RED:
  85         case PM8606_LED1_GREEN:
  86         case PM8606_LED1_BLUE:
  87                 ret = PM8606_RGB1A;
  88                 break;
  89         case PM8606_LED2_RED:
  90         case PM8606_LED2_GREEN:
  91         case PM8606_LED2_BLUE:
  92                 ret = PM8606_RGB2A;
  93                 break;
  94         }
  95         return ret;
  96 }
  97
  98 static inline int __blink_ctl_mask(int port)
  99 {
 100         int ret = -EINVAL;
 101
 102         switch (port) {
 103         case PM8606_LED1_RED:
 104         case PM8606_LED1_GREEN:
 105         case PM8606_LED1_BLUE:
 106                 ret = LED1_BLINK_EN;
 107                 break;
 108         case PM8606_LED2_RED:
 109         case PM8606_LED2_GREEN:
 110         case PM8606_LED2_BLUE:
 111                 ret = LED2_BLINK_EN;
 112                 break;
 113         }
 114         return ret;
 115 }
 116
 117 static void pm860x_led_work(struct work_struct *work)
 118 {
 119
 120         struct pm860x_led *led;
 121         struct pm860x_chip *chip;
 122         unsigned char buf[3];
 123         int mask, ret;
 124
 125         led = container_of(work, struct pm860x_led, work);
 126         chip = led->chip;
 127         mutex_lock(&led->lock);
 128         if ((led->current_brightness == 0) && led->brightness) {
 129                 if (led->iset) {
 130                         pm860x_set_bits(led->i2c, __led_off(led->port),
 131                                         LED_CURRENT_MASK, led->iset);
 132                 }
 133                 pm860x_set_bits(led->i2c, __blink_off(led->port),
 134                                 LED_BLINK_MASK, LED_ON_CONTINUOUS);
 135                 mask = __blink_ctl_mask(led->port);
 136                 pm860x_set_bits(led->i2c, PM8606_WLED3B, mask, mask);
 137         }
 138         pm860x_set_bits(led->i2c, __led_off(led->port), LED_PWM_MASK,
 139                         led->brightness);
 140
 141         if (led->brightness == 0) {
 142                 pm860x_bulk_read(led->i2c, __led_off(led->port), 3, buf);
 143                 ret = buf[0] & LED_PWM_MASK;
 144                 ret |= buf[1] & LED_PWM_MASK;
 145                 ret |= buf[2] & LED_PWM_MASK;
 146                 if (ret == 0) {
 147                         /* unset current since no led is lighting */
 148                         pm860x_set_bits(led->i2c, __led_off(led->port),
 149                                         LED_CURRENT_MASK, 0);
 150                         mask = __blink_ctl_mask(led->port);
 151                         pm860x_set_bits(led->i2c, PM8606_WLED3B, mask, 0);
 152                 }
 153         }
 154         led->current_brightness = led->brightness;
 155         dev_dbg(chip->dev, "Update LED. (reg:%d, brightness:%d)\n",
 156                 __led_off(led->port), led->brightness);
 157         mutex_unlock(&led->lock);
 158 }
 159
 160 static void pm860x_led_set(struct led_classdev *cdev,
 161                            enum led_brightness value)
 162 {
 163         struct pm860x_led *data = container_of(cdev, struct pm860x_led, cdev);
 164
 165         data->brightness = value >> 3;
 166         schedule_work(&data->work);
 167 }
 168
 169 static int pm860x_led_probe(struct platform_device *pdev)
 170 {
 171         struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent);
 172         struct pm860x_led_pdata *pdata;
 173         struct pm860x_led *data;
 174         struct resource *res;
 175         int ret;
 176
 177         res = platform_get_resource(pdev, IORESOURCE_IO, 0);
 178         if (res == NULL) {
 179                 dev_err(&pdev->dev, "No I/O resource!\n");
 180                 return -EINVAL;
 181         }
 182
 183         pdata = pdev->dev.platform_data;
 184         if (pdata == NULL) {
 185                 dev_err(&pdev->dev, "No platform data!\n");
 186                 return -EINVAL;
 187         }
 188
 189         data = kzalloc(sizeof(struct pm860x_led), GFP_KERNEL);
 190         if (data == NULL)
 191                 return -ENOMEM;
 192         strncpy(data->name, res->name, MFD_NAME_SIZE - 1);
 193         dev_set_drvdata(&pdev->dev, data);
 194         data->chip = chip;
 195         data->i2c = (chip->id == CHIP_PM8606) ? chip->client : chip->companion;
 196         data->iset = pdata->iset;
 197         data->port = pdata->flags;
 198         if (data->port < 0) {
 199                 dev_err(&pdev->dev, "check device failed\n");
 200                 kfree(data);
 201                 return -EINVAL;
 202         }
 203
 204         data->current_brightness = 0;
 205         data->cdev.name = data->name;
 206         data->cdev.brightness_set = pm860x_led_set;
 207         mutex_init(&data->lock);
 208         INIT_WORK(&data->work, pm860x_led_work);
 209
 210         ret = led_classdev_register(chip->dev, &data->cdev);
 211         if (ret < 0) {
 212                 dev_err(&pdev->dev, "Failed to register LED: %d\n", ret);
 213                 goto out;
 214         }
 215         pm860x_led_set(&data->cdev, 0);
 216         return 0;
 217 out:
 218         kfree(data);
 219         return ret;
 220 }
 221
 222 static int pm860x_led_remove(struct platform_device *pdev)
 223 {
 224         struct pm860x_led *data = platform_get_drvdata(pdev);
 225
 226         led_classdev_unregister(&data->cdev);
 227         kfree(data);
 228
 229         return 0;
 230 }
 231
 232 static struct platform_driver pm860x_led_driver = {
 233         .driver = {
 234                 .name   = "88pm860x-led",
 235                 .owner  = THIS_MODULE,
 236         },
 237         .probe  = pm860x_led_probe,
 238         .remove = pm860x_led_remove,
 239 };
 240
 241 module_platform_driver(pm860x_led_driver);
 242
 243 MODULE_DESCRIPTION("LED driver for Marvell PM860x");
 244 MODULE_AUTHOR("Haojian Zhuang <haojian.zhuang@marvell.com>");
 245 MODULE_LICENSE("GPL");
 246 MODULE_ALIAS("platform:88pm860x-led");