Commit | Line | Data |
---|---|---|
76abbdde HS |
1 | /* |
2 | * A simple sysfs interface for the generic PWM framework | |
3 | * | |
4 | * Copyright (C) 2013 H Hartley Sweeten <hsweeten@visionengravers.com> | |
5 | * | |
6 | * Based on previous work by Lars Poeschel <poeschel@lemonage.de> | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License as published by | |
10 | * the Free Software Foundation; either version 2, or (at your option) | |
11 | * any later version. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, | |
14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
16 | * GNU General Public License for more details. | |
17 | */ | |
18 | ||
19 | #include <linux/device.h> | |
20 | #include <linux/mutex.h> | |
21 | #include <linux/err.h> | |
22 | #include <linux/slab.h> | |
23 | #include <linux/kdev_t.h> | |
24 | #include <linux/pwm.h> | |
25 | ||
26 | struct pwm_export { | |
27 | struct device child; | |
28 | struct pwm_device *pwm; | |
29 | }; | |
30 | ||
31 | static struct pwm_export *child_to_pwm_export(struct device *child) | |
32 | { | |
33 | return container_of(child, struct pwm_export, child); | |
34 | } | |
35 | ||
36 | static struct pwm_device *child_to_pwm_device(struct device *child) | |
37 | { | |
38 | struct pwm_export *export = child_to_pwm_export(child); | |
39 | ||
40 | return export->pwm; | |
41 | } | |
42 | ||
43 | static ssize_t pwm_period_show(struct device *child, | |
44 | struct device_attribute *attr, | |
45 | char *buf) | |
46 | { | |
47 | const struct pwm_device *pwm = child_to_pwm_device(child); | |
48 | ||
15da7b50 | 49 | return sprintf(buf, "%u\n", pwm_get_period(pwm)); |
76abbdde HS |
50 | } |
51 | ||
52 | static ssize_t pwm_period_store(struct device *child, | |
53 | struct device_attribute *attr, | |
54 | const char *buf, size_t size) | |
55 | { | |
56 | struct pwm_device *pwm = child_to_pwm_device(child); | |
57 | unsigned int val; | |
58 | int ret; | |
59 | ||
60 | ret = kstrtouint(buf, 0, &val); | |
61 | if (ret) | |
62 | return ret; | |
63 | ||
15da7b50 | 64 | ret = pwm_config(pwm, pwm_get_duty_cycle(pwm), val); |
76abbdde HS |
65 | |
66 | return ret ? : size; | |
67 | } | |
68 | ||
69 | static ssize_t pwm_duty_cycle_show(struct device *child, | |
70 | struct device_attribute *attr, | |
71 | char *buf) | |
72 | { | |
73 | const struct pwm_device *pwm = child_to_pwm_device(child); | |
74 | ||
15da7b50 | 75 | return sprintf(buf, "%u\n", pwm_get_duty_cycle(pwm)); |
76abbdde HS |
76 | } |
77 | ||
78 | static ssize_t pwm_duty_cycle_store(struct device *child, | |
79 | struct device_attribute *attr, | |
80 | const char *buf, size_t size) | |
81 | { | |
82 | struct pwm_device *pwm = child_to_pwm_device(child); | |
83 | unsigned int val; | |
84 | int ret; | |
85 | ||
86 | ret = kstrtouint(buf, 0, &val); | |
87 | if (ret) | |
88 | return ret; | |
89 | ||
15da7b50 | 90 | ret = pwm_config(pwm, val, pwm_get_period(pwm)); |
76abbdde HS |
91 | |
92 | return ret ? : size; | |
93 | } | |
94 | ||
95 | static ssize_t pwm_enable_show(struct device *child, | |
96 | struct device_attribute *attr, | |
97 | char *buf) | |
98 | { | |
99 | const struct pwm_device *pwm = child_to_pwm_device(child); | |
5c31252c | 100 | int enabled = pwm_is_enabled(pwm); |
76abbdde HS |
101 | |
102 | return sprintf(buf, "%d\n", enabled); | |
103 | } | |
104 | ||
105 | static ssize_t pwm_enable_store(struct device *child, | |
106 | struct device_attribute *attr, | |
107 | const char *buf, size_t size) | |
108 | { | |
109 | struct pwm_device *pwm = child_to_pwm_device(child); | |
110 | int val, ret; | |
111 | ||
112 | ret = kstrtoint(buf, 0, &val); | |
113 | if (ret) | |
114 | return ret; | |
115 | ||
116 | switch (val) { | |
117 | case 0: | |
118 | pwm_disable(pwm); | |
119 | break; | |
120 | case 1: | |
121 | ret = pwm_enable(pwm); | |
122 | break; | |
123 | default: | |
124 | ret = -EINVAL; | |
125 | break; | |
126 | } | |
127 | ||
128 | return ret ? : size; | |
129 | } | |
130 | ||
131 | static ssize_t pwm_polarity_show(struct device *child, | |
132 | struct device_attribute *attr, | |
133 | char *buf) | |
134 | { | |
135 | const struct pwm_device *pwm = child_to_pwm_device(child); | |
136 | ||
15da7b50 BB |
137 | return sprintf(buf, "%s\n", |
138 | pwm_get_polarity(pwm) ? "inversed" : "normal"); | |
76abbdde HS |
139 | } |
140 | ||
141 | static ssize_t pwm_polarity_store(struct device *child, | |
142 | struct device_attribute *attr, | |
143 | const char *buf, size_t size) | |
144 | { | |
145 | struct pwm_device *pwm = child_to_pwm_device(child); | |
146 | enum pwm_polarity polarity; | |
147 | int ret; | |
148 | ||
149 | if (sysfs_streq(buf, "normal")) | |
150 | polarity = PWM_POLARITY_NORMAL; | |
151 | else if (sysfs_streq(buf, "inversed")) | |
152 | polarity = PWM_POLARITY_INVERSED; | |
153 | else | |
154 | return -EINVAL; | |
155 | ||
156 | ret = pwm_set_polarity(pwm, polarity); | |
157 | ||
158 | return ret ? : size; | |
159 | } | |
160 | ||
161 | static DEVICE_ATTR(period, 0644, pwm_period_show, pwm_period_store); | |
162 | static DEVICE_ATTR(duty_cycle, 0644, pwm_duty_cycle_show, pwm_duty_cycle_store); | |
163 | static DEVICE_ATTR(enable, 0644, pwm_enable_show, pwm_enable_store); | |
164 | static DEVICE_ATTR(polarity, 0644, pwm_polarity_show, pwm_polarity_store); | |
165 | ||
166 | static struct attribute *pwm_attrs[] = { | |
167 | &dev_attr_period.attr, | |
168 | &dev_attr_duty_cycle.attr, | |
169 | &dev_attr_enable.attr, | |
170 | &dev_attr_polarity.attr, | |
171 | NULL | |
172 | }; | |
6ca142ad | 173 | ATTRIBUTE_GROUPS(pwm); |
76abbdde HS |
174 | |
175 | static void pwm_export_release(struct device *child) | |
176 | { | |
177 | struct pwm_export *export = child_to_pwm_export(child); | |
178 | ||
179 | kfree(export); | |
180 | } | |
181 | ||
182 | static int pwm_export_child(struct device *parent, struct pwm_device *pwm) | |
183 | { | |
184 | struct pwm_export *export; | |
185 | int ret; | |
186 | ||
187 | if (test_and_set_bit(PWMF_EXPORTED, &pwm->flags)) | |
188 | return -EBUSY; | |
189 | ||
190 | export = kzalloc(sizeof(*export), GFP_KERNEL); | |
191 | if (!export) { | |
192 | clear_bit(PWMF_EXPORTED, &pwm->flags); | |
193 | return -ENOMEM; | |
194 | } | |
195 | ||
196 | export->pwm = pwm; | |
197 | ||
198 | export->child.release = pwm_export_release; | |
199 | export->child.parent = parent; | |
200 | export->child.devt = MKDEV(0, 0); | |
6ca142ad | 201 | export->child.groups = pwm_groups; |
76abbdde HS |
202 | dev_set_name(&export->child, "pwm%u", pwm->hwpwm); |
203 | ||
204 | ret = device_register(&export->child); | |
205 | if (ret) { | |
206 | clear_bit(PWMF_EXPORTED, &pwm->flags); | |
207 | kfree(export); | |
208 | return ret; | |
209 | } | |
210 | ||
211 | return 0; | |
212 | } | |
213 | ||
214 | static int pwm_unexport_match(struct device *child, void *data) | |
215 | { | |
216 | return child_to_pwm_device(child) == data; | |
217 | } | |
218 | ||
219 | static int pwm_unexport_child(struct device *parent, struct pwm_device *pwm) | |
220 | { | |
221 | struct device *child; | |
222 | ||
223 | if (!test_and_clear_bit(PWMF_EXPORTED, &pwm->flags)) | |
224 | return -ENODEV; | |
225 | ||
226 | child = device_find_child(parent, pwm, pwm_unexport_match); | |
227 | if (!child) | |
228 | return -ENODEV; | |
229 | ||
230 | /* for device_find_child() */ | |
231 | put_device(child); | |
232 | device_unregister(child); | |
233 | pwm_put(pwm); | |
234 | ||
235 | return 0; | |
236 | } | |
237 | ||
238 | static ssize_t pwm_export_store(struct device *parent, | |
239 | struct device_attribute *attr, | |
240 | const char *buf, size_t len) | |
241 | { | |
242 | struct pwm_chip *chip = dev_get_drvdata(parent); | |
243 | struct pwm_device *pwm; | |
244 | unsigned int hwpwm; | |
245 | int ret; | |
246 | ||
247 | ret = kstrtouint(buf, 0, &hwpwm); | |
248 | if (ret < 0) | |
249 | return ret; | |
250 | ||
251 | if (hwpwm >= chip->npwm) | |
252 | return -ENODEV; | |
253 | ||
254 | pwm = pwm_request_from_chip(chip, hwpwm, "sysfs"); | |
255 | if (IS_ERR(pwm)) | |
256 | return PTR_ERR(pwm); | |
257 | ||
258 | ret = pwm_export_child(parent, pwm); | |
259 | if (ret < 0) | |
260 | pwm_put(pwm); | |
261 | ||
262 | return ret ? : len; | |
263 | } | |
9da01759 | 264 | static DEVICE_ATTR(export, 0200, NULL, pwm_export_store); |
76abbdde HS |
265 | |
266 | static ssize_t pwm_unexport_store(struct device *parent, | |
267 | struct device_attribute *attr, | |
268 | const char *buf, size_t len) | |
269 | { | |
270 | struct pwm_chip *chip = dev_get_drvdata(parent); | |
271 | unsigned int hwpwm; | |
272 | int ret; | |
273 | ||
274 | ret = kstrtouint(buf, 0, &hwpwm); | |
275 | if (ret < 0) | |
276 | return ret; | |
277 | ||
278 | if (hwpwm >= chip->npwm) | |
279 | return -ENODEV; | |
280 | ||
281 | ret = pwm_unexport_child(parent, &chip->pwms[hwpwm]); | |
282 | ||
283 | return ret ? : len; | |
284 | } | |
9da01759 | 285 | static DEVICE_ATTR(unexport, 0200, NULL, pwm_unexport_store); |
76abbdde | 286 | |
9da01759 GKH |
287 | static ssize_t npwm_show(struct device *parent, struct device_attribute *attr, |
288 | char *buf) | |
76abbdde HS |
289 | { |
290 | const struct pwm_chip *chip = dev_get_drvdata(parent); | |
291 | ||
292 | return sprintf(buf, "%u\n", chip->npwm); | |
293 | } | |
9da01759 | 294 | static DEVICE_ATTR_RO(npwm); |
76abbdde | 295 | |
9da01759 GKH |
296 | static struct attribute *pwm_chip_attrs[] = { |
297 | &dev_attr_export.attr, | |
298 | &dev_attr_unexport.attr, | |
299 | &dev_attr_npwm.attr, | |
300 | NULL, | |
76abbdde | 301 | }; |
9da01759 | 302 | ATTRIBUTE_GROUPS(pwm_chip); |
76abbdde HS |
303 | |
304 | static struct class pwm_class = { | |
305 | .name = "pwm", | |
306 | .owner = THIS_MODULE, | |
9da01759 | 307 | .dev_groups = pwm_chip_groups, |
76abbdde HS |
308 | }; |
309 | ||
310 | static int pwmchip_sysfs_match(struct device *parent, const void *data) | |
311 | { | |
312 | return dev_get_drvdata(parent) == data; | |
313 | } | |
314 | ||
315 | void pwmchip_sysfs_export(struct pwm_chip *chip) | |
316 | { | |
317 | struct device *parent; | |
318 | ||
319 | /* | |
320 | * If device_create() fails the pwm_chip is still usable by | |
321 | * the kernel its just not exported. | |
322 | */ | |
323 | parent = device_create(&pwm_class, chip->dev, MKDEV(0, 0), chip, | |
324 | "pwmchip%d", chip->base); | |
325 | if (IS_ERR(parent)) { | |
326 | dev_warn(chip->dev, | |
327 | "device_create failed for pwm_chip sysfs export\n"); | |
328 | } | |
329 | } | |
330 | ||
331 | void pwmchip_sysfs_unexport(struct pwm_chip *chip) | |
332 | { | |
333 | struct device *parent; | |
334 | ||
335 | parent = class_find_device(&pwm_class, NULL, chip, | |
336 | pwmchip_sysfs_match); | |
337 | if (parent) { | |
338 | /* for class_find_device() */ | |
339 | put_device(parent); | |
340 | device_unregister(parent); | |
341 | } | |
342 | } | |
343 | ||
344 | static int __init pwm_sysfs_init(void) | |
345 | { | |
346 | return class_register(&pwm_class); | |
347 | } | |
348 | subsys_initcall(pwm_sysfs_init); |