Commit | Line | Data |
---|---|---|
55d5d3b4 DM |
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 | ||
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 | ||
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 | ||
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 | ||
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 | ||
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 | ||
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 | ||
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 | ||
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 | ||
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 | ||
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"); |