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 int led_power_set(struct pm860x_chip *chip, int port, int on) 118 { 119 int ret = -EINVAL; 120 121 switch (port) { 122 case PM8606_LED1_RED: 123 case PM8606_LED1_GREEN: 124 case PM8606_LED1_BLUE: 125 ret = on ? pm8606_osc_enable(chip, RGB1_ENABLE) : 126 pm8606_osc_disable(chip, RGB1_ENABLE); 127 break; 128 case PM8606_LED2_RED: 129 case PM8606_LED2_GREEN: 130 case PM8606_LED2_BLUE: 131 ret = on ? pm8606_osc_enable(chip, RGB2_ENABLE) : 132 pm8606_osc_disable(chip, RGB2_ENABLE); 133 break; 134 } 135 return ret; 136 } 137 138 static void pm860x_led_work(struct work_struct *work) 139 { 140 141 struct pm860x_led *led; 142 struct pm860x_chip *chip; 143 unsigned char buf[3]; 144 int mask, ret; 145 146 led = container_of(work, struct pm860x_led, work); 147 chip = led->chip; 148 mutex_lock(&led->lock); 149 if ((led->current_brightness == 0) && led->brightness) { 150 led_power_set(chip, led->port, 1); 151 if (led->iset) { 152 pm860x_set_bits(led->i2c, __led_off(led->port), 153 LED_CURRENT_MASK, led->iset); 154 } 155 pm860x_set_bits(led->i2c, __blink_off(led->port), 156 LED_BLINK_MASK, LED_ON_CONTINUOUS); 157 mask = __blink_ctl_mask(led->port); 158 pm860x_set_bits(led->i2c, PM8606_WLED3B, mask, mask); 159 } 160 pm860x_set_bits(led->i2c, __led_off(led->port), LED_PWM_MASK, 161 led->brightness); 162 163 if (led->brightness == 0) { 164 pm860x_bulk_read(led->i2c, __led_off(led->port), 3, buf); 165 ret = buf[0] & LED_PWM_MASK; 166 ret |= buf[1] & LED_PWM_MASK; 167 ret |= buf[2] & LED_PWM_MASK; 168 if (ret == 0) { 169 /* unset current since no led is lighting */ 170 pm860x_set_bits(led->i2c, __led_off(led->port), 171 LED_CURRENT_MASK, 0); 172 mask = __blink_ctl_mask(led->port); 173 pm860x_set_bits(led->i2c, PM8606_WLED3B, mask, 0); 174 led_power_set(chip, led->port, 0); 175 } 176 } 177 led->current_brightness = led->brightness; 178 dev_dbg(chip->dev, "Update LED. (reg:%d, brightness:%d)\n", 179 __led_off(led->port), led->brightness); 180 mutex_unlock(&led->lock); 181 } 182 183 static void pm860x_led_set(struct led_classdev *cdev, 184 enum led_brightness value) 185 { 186 struct pm860x_led *data = container_of(cdev, struct pm860x_led, cdev); 187 188 data->brightness = value >> 3; 189 schedule_work(&data->work); 190 } 191 192 static int pm860x_led_probe(struct platform_device *pdev) 193 { 194 struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent); 195 struct pm860x_led_pdata *pdata; 196 struct pm860x_led *data; 197 struct resource *res; 198 int ret; 199 200 res = platform_get_resource(pdev, IORESOURCE_IO, 0); 201 if (res == NULL) { 202 dev_err(&pdev->dev, "No I/O resource!\n"); 203 return -EINVAL; 204 } 205 206 pdata = pdev->dev.platform_data; 207 if (pdata == NULL) { 208 dev_err(&pdev->dev, "No platform data!\n"); 209 return -EINVAL; 210 } 211 212 data = kzalloc(sizeof(struct pm860x_led), GFP_KERNEL); 213 if (data == NULL) 214 return -ENOMEM; 215 strncpy(data->name, res->name, MFD_NAME_SIZE - 1); 216 dev_set_drvdata(&pdev->dev, data); 217 data->chip = chip; 218 data->i2c = (chip->id == CHIP_PM8606) ? chip->client : chip->companion; 219 data->iset = pdata->iset; 220 data->port = pdata->flags; 221 if (data->port < 0) { 222 dev_err(&pdev->dev, "check device failed\n"); 223 kfree(data); 224 return -EINVAL; 225 } 226 227 data->current_brightness = 0; 228 data->cdev.name = data->name; 229 data->cdev.brightness_set = pm860x_led_set; 230 mutex_init(&data->lock); 231 INIT_WORK(&data->work, pm860x_led_work); 232 233 ret = led_classdev_register(chip->dev, &data->cdev); 234 if (ret < 0) { 235 dev_err(&pdev->dev, "Failed to register LED: %d\n", ret); 236 goto out; 237 } 238 pm860x_led_set(&data->cdev, 0); 239 return 0; 240 out: 241 kfree(data); 242 return ret; 243 } 244 245 static int pm860x_led_remove(struct platform_device *pdev) 246 { 247 struct pm860x_led *data = platform_get_drvdata(pdev); 248 249 led_classdev_unregister(&data->cdev); 250 kfree(data); 251 252 return 0; 253 } 254 255 static struct platform_driver pm860x_led_driver = { 256 .driver = { 257 .name = "88pm860x-led", 258 .owner = THIS_MODULE, 259 }, 260 .probe = pm860x_led_probe, 261 .remove = pm860x_led_remove, 262 }; 263 264 module_platform_driver(pm860x_led_driver); 265 266 MODULE_DESCRIPTION("LED driver for Marvell PM860x"); 267 MODULE_AUTHOR("Haojian Zhuang <haojian.zhuang@marvell.com>"); 268 MODULE_LICENSE("GPL"); 269 MODULE_ALIAS("platform:88pm860x-led"); 270