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