blob: 0810604dc701307973f2967b8fd578f5a9bee997 [file] [log] [blame]
Haojian Zhuang0a2f9152010-01-06 17:10:09 -05001/*
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>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090018#include <linux/slab.h>
Haojian Zhuang0a2f9152010-01-06 17:10:09 -050019#include <linux/workqueue.h>
20#include <linux/mfd/88pm860x.h>
Paul Gortmaker54f4ded2011-07-03 13:56:03 -040021#include <linux/module.h>
Haojian Zhuang0a2f9152010-01-06 17:10:09 -050022
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)
Haojian Zhuang0a2f9152010-01-06 17:10:09 -050028#define LED_BLINK_MASK (0x7F)
29
30#define LED_BLINK_ON(x) ((x & 0x7) * 66 + 66)
Haojian Zhuang0a2f9152010-01-06 17:10:09 -050031#define LED_BLINK_ON_MIN LED_BLINK_ON(0)
32#define LED_BLINK_ON_MAX LED_BLINK_ON(0x7)
Haojian Zhuangf5d59fc2010-09-08 09:44:33 -040033#define LED_ON_CONTINUOUS (0x0F << 3)
Haojian Zhuang0a2f9152010-01-06 17:10:09 -050034#define LED_TO_ON(x) ((x - 66) / 66)
Haojian Zhuang0a2f9152010-01-06 17:10:09 -050035
36#define LED1_BLINK_EN (1 << 1)
37#define LED2_BLINK_EN (1 << 2)
38
Haojian Zhuang0a2f9152010-01-06 17:10:09 -050039struct 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;
Haojian Zhuang0a2f9152010-01-06 17:10:09 -050049 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 */
59static 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 */
79static 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;
Haojian Zhuangf5d59fc2010-09-08 09:44:33 -040088 break;
Haojian Zhuang0a2f9152010-01-06 17:10:09 -050089 case PM8606_LED2_RED:
90 case PM8606_LED2_GREEN:
91 case PM8606_LED2_BLUE:
92 ret = PM8606_RGB2A;
Haojian Zhuangf5d59fc2010-09-08 09:44:33 -040093 break;
Haojian Zhuang0a2f9152010-01-06 17:10:09 -050094 }
95 return ret;
96}
97
98static 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
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500117static void pm860x_led_work(struct work_struct *work)
118{
Haojian Zhuangf5d59fc2010-09-08 09:44:33 -0400119
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500120 struct pm860x_led *led;
Haojian Zhuangf5d59fc2010-09-08 09:44:33 -0400121 struct pm860x_chip *chip;
Haojian Zhuang3154c342011-03-07 23:43:10 +0800122 unsigned char buf[3];
123 int mask, ret;
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500124
125 led = container_of(work, struct pm860x_led, work);
Haojian Zhuangf5d59fc2010-09-08 09:44:33 -0400126 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 }
Haojian Zhuang3154c342011-03-07 23:43:10 +0800133 pm860x_set_bits(led->i2c, __blink_off(led->port),
134 LED_BLINK_MASK, LED_ON_CONTINUOUS);
Haojian Zhuangf5d59fc2010-09-08 09:44:33 -0400135 mask = __blink_ctl_mask(led->port);
136 pm860x_set_bits(led->i2c, PM8606_WLED3B, mask, mask);
Haojian Zhuangf5d59fc2010-09-08 09:44:33 -0400137 }
138 pm860x_set_bits(led->i2c, __led_off(led->port), LED_PWM_MASK,
139 led->brightness);
Haojian Zhuang3154c342011-03-07 23:43:10 +0800140
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 }
Haojian Zhuangf5d59fc2010-09-08 09:44:33 -0400154 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);
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500158}
159
160static 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
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500165 data->brightness = value >> 3;
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500166 schedule_work(&data->work);
167}
168
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500169static int pm860x_led_probe(struct platform_device *pdev)
170{
171 struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent);
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500172 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
Samuel Ortiz07259a72011-04-06 16:26:56 +0200183 pdata = pdev->dev.platform_data;
Haojian Zhuang3154c342011-03-07 23:43:10 +0800184 if (pdata == NULL) {
Haojian Zhuangf5d59fc2010-09-08 09:44:33 -0400185 dev_err(&pdev->dev, "No platform data!\n");
Christoph Fritz98652ef2010-04-17 13:57:17 +0200186 return -EINVAL;
187 }
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500188
189 data = kzalloc(sizeof(struct pm860x_led), GFP_KERNEL);
190 if (data == NULL)
191 return -ENOMEM;
Haojian Zhuang3154c342011-03-07 23:43:10 +0800192 strncpy(data->name, res->name, MFD_NAME_SIZE - 1);
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500193 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;
Haojian Zhuang3154c342011-03-07 23:43:10 +0800197 data->port = pdata->flags;
Christoph Fritz98652ef2010-04-17 13:57:17 +0200198 if (data->port < 0) {
199 dev_err(&pdev->dev, "check device failed\n");
200 kfree(data);
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500201 return -EINVAL;
Christoph Fritz98652ef2010-04-17 13:57:17 +0200202 }
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500203
204 data->current_brightness = 0;
205 data->cdev.name = data->name;
206 data->cdev.brightness_set = pm860x_led_set;
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500207 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 }
Haojian Zhuang3154c342011-03-07 23:43:10 +0800215 pm860x_led_set(&data->cdev, 0);
Haojian Zhuang0a2f9152010-01-06 17:10:09 -0500216 return 0;
217out:
218 kfree(data);
219 return ret;
220}
221
222static 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
232static 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
241static int __devinit pm860x_led_init(void)
242{
243 return platform_driver_register(&pm860x_led_driver);
244}
245module_init(pm860x_led_init);
246
247static void __devexit pm860x_led_exit(void)
248{
249 platform_driver_unregister(&pm860x_led_driver);
250}
251module_exit(pm860x_led_exit);
252
253MODULE_DESCRIPTION("LED driver for Marvell PM860x");
254MODULE_AUTHOR("Haojian Zhuang <haojian.zhuang@marvell.com>");
255MODULE_LICENSE("GPL");
256MODULE_ALIAS("platform:88pm860x-led");