1 // SPDX-License-Identifier: GPL-2.0
2 // LED Multicolor class interface
3 // Copyright (C) 2019-20 Texas Instruments Incorporated - http://www.ti.com/
4 // Author: Dan Murphy <dmurphy@ti.com>
5 
6 #include <linux/device.h>
7 #include <linux/init.h>
8 #include <linux/led-class-multicolor.h>
9 #include <linux/module.h>
10 #include <linux/slab.h>
11 #include <linux/uaccess.h>
12 
13 #include "leds.h"
14 
led_mc_calc_color_components(struct led_classdev_mc * mcled_cdev,enum led_brightness brightness)15 int led_mc_calc_color_components(struct led_classdev_mc *mcled_cdev,
16 				 enum led_brightness brightness)
17 {
18 	struct led_classdev *led_cdev = &mcled_cdev->led_cdev;
19 	int i;
20 
21 	for (i = 0; i < mcled_cdev->num_colors; i++)
22 		mcled_cdev->subled_info[i].brightness = brightness *
23 					mcled_cdev->subled_info[i].intensity /
24 					led_cdev->max_brightness;
25 
26 	return 0;
27 }
28 EXPORT_SYMBOL_GPL(led_mc_calc_color_components);
29 
multi_intensity_store(struct device * dev,struct device_attribute * intensity_attr,const char * buf,size_t size)30 static ssize_t multi_intensity_store(struct device *dev,
31 				struct device_attribute *intensity_attr,
32 				const char *buf, size_t size)
33 {
34 	struct led_classdev *led_cdev = dev_get_drvdata(dev);
35 	struct led_classdev_mc *mcled_cdev = lcdev_to_mccdev(led_cdev);
36 	int nrchars, offset = 0;
37 	int intensity_value[LED_COLOR_ID_MAX];
38 	int i;
39 	ssize_t ret;
40 
41 	mutex_lock(&led_cdev->led_access);
42 
43 	for (i = 0; i < mcled_cdev->num_colors; i++) {
44 		ret = sscanf(buf + offset, "%i%n",
45 			     &intensity_value[i], &nrchars);
46 		if (ret != 1) {
47 			ret = -EINVAL;
48 			goto err_out;
49 		}
50 		offset += nrchars;
51 	}
52 
53 	offset++;
54 	if (offset < size) {
55 		ret = -EINVAL;
56 		goto err_out;
57 	}
58 
59 	for (i = 0; i < mcled_cdev->num_colors; i++)
60 		mcled_cdev->subled_info[i].intensity = intensity_value[i];
61 
62 	led_set_brightness(led_cdev, led_cdev->brightness);
63 	ret = size;
64 err_out:
65 	mutex_unlock(&led_cdev->led_access);
66 	return ret;
67 }
68 
multi_intensity_show(struct device * dev,struct device_attribute * intensity_attr,char * buf)69 static ssize_t multi_intensity_show(struct device *dev,
70 			      struct device_attribute *intensity_attr,
71 			      char *buf)
72 {
73 	struct led_classdev *led_cdev = dev_get_drvdata(dev);
74 	struct led_classdev_mc *mcled_cdev = lcdev_to_mccdev(led_cdev);
75 	int len = 0;
76 	int i;
77 
78 	for (i = 0; i < mcled_cdev->num_colors; i++) {
79 		len += sprintf(buf + len, "%d",
80 			       mcled_cdev->subled_info[i].intensity);
81 		if (i < mcled_cdev->num_colors - 1)
82 			len += sprintf(buf + len, " ");
83 	}
84 
85 	buf[len++] = '\n';
86 	return len;
87 }
88 static DEVICE_ATTR_RW(multi_intensity);
89 
multi_index_show(struct device * dev,struct device_attribute * multi_index_attr,char * buf)90 static ssize_t multi_index_show(struct device *dev,
91 			      struct device_attribute *multi_index_attr,
92 			      char *buf)
93 {
94 	struct led_classdev *led_cdev = dev_get_drvdata(dev);
95 	struct led_classdev_mc *mcled_cdev = lcdev_to_mccdev(led_cdev);
96 	int len = 0;
97 	int index;
98 	int i;
99 
100 	for (i = 0; i < mcled_cdev->num_colors; i++) {
101 		index = mcled_cdev->subled_info[i].color_index;
102 		len += sprintf(buf + len, "%s", led_colors[index]);
103 		if (i < mcled_cdev->num_colors - 1)
104 			len += sprintf(buf + len, " ");
105 	}
106 
107 	buf[len++] = '\n';
108 	return len;
109 }
110 static DEVICE_ATTR_RO(multi_index);
111 
112 static struct attribute *led_multicolor_attrs[] = {
113 	&dev_attr_multi_intensity.attr,
114 	&dev_attr_multi_index.attr,
115 	NULL,
116 };
117 ATTRIBUTE_GROUPS(led_multicolor);
118 
led_classdev_multicolor_register_ext(struct device * parent,struct led_classdev_mc * mcled_cdev,struct led_init_data * init_data)119 int led_classdev_multicolor_register_ext(struct device *parent,
120 				     struct led_classdev_mc *mcled_cdev,
121 				     struct led_init_data *init_data)
122 {
123 	struct led_classdev *led_cdev;
124 
125 	if (!mcled_cdev)
126 		return -EINVAL;
127 
128 	if (mcled_cdev->num_colors <= 0)
129 		return -EINVAL;
130 
131 	if (mcled_cdev->num_colors > LED_COLOR_ID_MAX)
132 		return -EINVAL;
133 
134 	led_cdev = &mcled_cdev->led_cdev;
135 	mcled_cdev->led_cdev.groups = led_multicolor_groups;
136 
137 	return led_classdev_register_ext(parent, led_cdev, init_data);
138 }
139 EXPORT_SYMBOL_GPL(led_classdev_multicolor_register_ext);
140 
led_classdev_multicolor_unregister(struct led_classdev_mc * mcled_cdev)141 void led_classdev_multicolor_unregister(struct led_classdev_mc *mcled_cdev)
142 {
143 	if (!mcled_cdev)
144 		return;
145 
146 	led_classdev_unregister(&mcled_cdev->led_cdev);
147 }
148 EXPORT_SYMBOL_GPL(led_classdev_multicolor_unregister);
149 
devm_led_classdev_multicolor_release(struct device * dev,void * res)150 static void devm_led_classdev_multicolor_release(struct device *dev, void *res)
151 {
152 	led_classdev_multicolor_unregister(*(struct led_classdev_mc **)res);
153 }
154 
devm_led_classdev_multicolor_register_ext(struct device * parent,struct led_classdev_mc * mcled_cdev,struct led_init_data * init_data)155 int devm_led_classdev_multicolor_register_ext(struct device *parent,
156 					     struct led_classdev_mc *mcled_cdev,
157 					     struct led_init_data *init_data)
158 {
159 	struct led_classdev_mc **dr;
160 	int ret;
161 
162 	dr = devres_alloc(devm_led_classdev_multicolor_release,
163 			  sizeof(*dr), GFP_KERNEL);
164 	if (!dr)
165 		return -ENOMEM;
166 
167 	ret = led_classdev_multicolor_register_ext(parent, mcled_cdev,
168 						   init_data);
169 	if (ret) {
170 		devres_free(dr);
171 		return ret;
172 	}
173 
174 	*dr = mcled_cdev;
175 	devres_add(parent, dr);
176 
177 	return 0;
178 }
179 EXPORT_SYMBOL_GPL(devm_led_classdev_multicolor_register_ext);
180 
devm_led_classdev_multicolor_match(struct device * dev,void * res,void * data)181 static int devm_led_classdev_multicolor_match(struct device *dev,
182 					      void *res, void *data)
183 {
184 	struct led_classdev_mc **p = res;
185 
186 	if (WARN_ON(!p || !*p))
187 		return 0;
188 
189 	return *p == data;
190 }
191 
devm_led_classdev_multicolor_unregister(struct device * dev,struct led_classdev_mc * mcled_cdev)192 void devm_led_classdev_multicolor_unregister(struct device *dev,
193 					     struct led_classdev_mc *mcled_cdev)
194 {
195 	WARN_ON(devres_release(dev,
196 			       devm_led_classdev_multicolor_release,
197 			       devm_led_classdev_multicolor_match, mcled_cdev));
198 }
199 EXPORT_SYMBOL_GPL(devm_led_classdev_multicolor_unregister);
200 
201 MODULE_AUTHOR("Dan Murphy <dmurphy@ti.com>");
202 MODULE_DESCRIPTION("Multicolor LED class interface");
203 MODULE_LICENSE("GPL v2");
204