]>
Commit | Line | Data |
---|---|---|
76abbdde HS |
1 | /* |
2 | * A simple sysfs interface for the generic PWM framework | |
3 | * | |
4 | * Copyright (C) 2013 H Hartley Sweeten <[email protected]> | |
5 | * | |
6 | * Based on previous work by Lars Poeschel <[email protected]> | |
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; | |
459a25af | 29 | struct mutex lock; |
76abbdde HS |
30 | }; |
31 | ||
32 | static struct pwm_export *child_to_pwm_export(struct device *child) | |
33 | { | |
34 | return container_of(child, struct pwm_export, child); | |
35 | } | |
36 | ||
37 | static struct pwm_device *child_to_pwm_device(struct device *child) | |
38 | { | |
39 | struct pwm_export *export = child_to_pwm_export(child); | |
40 | ||
41 | return export->pwm; | |
42 | } | |
43 | ||
65cdc691 OS |
44 | static ssize_t period_show(struct device *child, |
45 | struct device_attribute *attr, | |
46 | char *buf) | |
76abbdde HS |
47 | { |
48 | const struct pwm_device *pwm = child_to_pwm_device(child); | |
39100cee | 49 | struct pwm_state state; |
76abbdde | 50 | |
39100cee BB |
51 | pwm_get_state(pwm, &state); |
52 | ||
53 | return sprintf(buf, "%u\n", state.period); | |
76abbdde HS |
54 | } |
55 | ||
65cdc691 OS |
56 | static ssize_t period_store(struct device *child, |
57 | struct device_attribute *attr, | |
58 | const char *buf, size_t size) | |
76abbdde | 59 | { |
459a25af BB |
60 | struct pwm_export *export = child_to_pwm_export(child); |
61 | struct pwm_device *pwm = export->pwm; | |
39100cee | 62 | struct pwm_state state; |
76abbdde HS |
63 | unsigned int val; |
64 | int ret; | |
65 | ||
66 | ret = kstrtouint(buf, 0, &val); | |
67 | if (ret) | |
68 | return ret; | |
69 | ||
459a25af | 70 | mutex_lock(&export->lock); |
39100cee BB |
71 | pwm_get_state(pwm, &state); |
72 | state.period = val; | |
73 | ret = pwm_apply_state(pwm, &state); | |
459a25af | 74 | mutex_unlock(&export->lock); |
76abbdde HS |
75 | |
76 | return ret ? : size; | |
77 | } | |
78 | ||
65cdc691 OS |
79 | static ssize_t duty_cycle_show(struct device *child, |
80 | struct device_attribute *attr, | |
81 | char *buf) | |
76abbdde HS |
82 | { |
83 | const struct pwm_device *pwm = child_to_pwm_device(child); | |
39100cee BB |
84 | struct pwm_state state; |
85 | ||
86 | pwm_get_state(pwm, &state); | |
76abbdde | 87 | |
39100cee | 88 | return sprintf(buf, "%u\n", state.duty_cycle); |
76abbdde HS |
89 | } |
90 | ||
65cdc691 OS |
91 | static ssize_t duty_cycle_store(struct device *child, |
92 | struct device_attribute *attr, | |
93 | const char *buf, size_t size) | |
76abbdde | 94 | { |
459a25af BB |
95 | struct pwm_export *export = child_to_pwm_export(child); |
96 | struct pwm_device *pwm = export->pwm; | |
39100cee | 97 | struct pwm_state state; |
76abbdde HS |
98 | unsigned int val; |
99 | int ret; | |
100 | ||
101 | ret = kstrtouint(buf, 0, &val); | |
102 | if (ret) | |
103 | return ret; | |
104 | ||
459a25af | 105 | mutex_lock(&export->lock); |
39100cee BB |
106 | pwm_get_state(pwm, &state); |
107 | state.duty_cycle = val; | |
108 | ret = pwm_apply_state(pwm, &state); | |
459a25af | 109 | mutex_unlock(&export->lock); |
76abbdde HS |
110 | |
111 | return ret ? : size; | |
112 | } | |
113 | ||
65cdc691 OS |
114 | static ssize_t enable_show(struct device *child, |
115 | struct device_attribute *attr, | |
116 | char *buf) | |
76abbdde HS |
117 | { |
118 | const struct pwm_device *pwm = child_to_pwm_device(child); | |
39100cee | 119 | struct pwm_state state; |
76abbdde | 120 | |
39100cee BB |
121 | pwm_get_state(pwm, &state); |
122 | ||
123 | return sprintf(buf, "%d\n", state.enabled); | |
76abbdde HS |
124 | } |
125 | ||
65cdc691 OS |
126 | static ssize_t enable_store(struct device *child, |
127 | struct device_attribute *attr, | |
128 | const char *buf, size_t size) | |
76abbdde | 129 | { |
459a25af BB |
130 | struct pwm_export *export = child_to_pwm_export(child); |
131 | struct pwm_device *pwm = export->pwm; | |
39100cee | 132 | struct pwm_state state; |
76abbdde HS |
133 | int val, ret; |
134 | ||
135 | ret = kstrtoint(buf, 0, &val); | |
136 | if (ret) | |
137 | return ret; | |
138 | ||
459a25af BB |
139 | mutex_lock(&export->lock); |
140 | ||
39100cee BB |
141 | pwm_get_state(pwm, &state); |
142 | ||
76abbdde HS |
143 | switch (val) { |
144 | case 0: | |
39100cee | 145 | state.enabled = false; |
76abbdde HS |
146 | break; |
147 | case 1: | |
39100cee | 148 | state.enabled = true; |
76abbdde HS |
149 | break; |
150 | default: | |
151 | ret = -EINVAL; | |
39100cee | 152 | goto unlock; |
76abbdde HS |
153 | } |
154 | ||
fe5aa34d | 155 | ret = pwm_apply_state(pwm, &state); |
459a25af | 156 | |
39100cee BB |
157 | unlock: |
158 | mutex_unlock(&export->lock); | |
76abbdde HS |
159 | return ret ? : size; |
160 | } | |
161 | ||
65cdc691 OS |
162 | static ssize_t polarity_show(struct device *child, |
163 | struct device_attribute *attr, | |
164 | char *buf) | |
76abbdde HS |
165 | { |
166 | const struct pwm_device *pwm = child_to_pwm_device(child); | |
5a063d87 | 167 | const char *polarity = "unknown"; |
39100cee BB |
168 | struct pwm_state state; |
169 | ||
170 | pwm_get_state(pwm, &state); | |
76abbdde | 171 | |
39100cee | 172 | switch (state.polarity) { |
5a063d87 TR |
173 | case PWM_POLARITY_NORMAL: |
174 | polarity = "normal"; | |
175 | break; | |
176 | ||
177 | case PWM_POLARITY_INVERSED: | |
178 | polarity = "inversed"; | |
179 | break; | |
180 | } | |
181 | ||
182 | return sprintf(buf, "%s\n", polarity); | |
76abbdde HS |
183 | } |
184 | ||
65cdc691 OS |
185 | static ssize_t polarity_store(struct device *child, |
186 | struct device_attribute *attr, | |
187 | const char *buf, size_t size) | |
76abbdde | 188 | { |
459a25af BB |
189 | struct pwm_export *export = child_to_pwm_export(child); |
190 | struct pwm_device *pwm = export->pwm; | |
76abbdde | 191 | enum pwm_polarity polarity; |
39100cee | 192 | struct pwm_state state; |
76abbdde HS |
193 | int ret; |
194 | ||
195 | if (sysfs_streq(buf, "normal")) | |
196 | polarity = PWM_POLARITY_NORMAL; | |
197 | else if (sysfs_streq(buf, "inversed")) | |
198 | polarity = PWM_POLARITY_INVERSED; | |
199 | else | |
200 | return -EINVAL; | |
201 | ||
459a25af | 202 | mutex_lock(&export->lock); |
39100cee BB |
203 | pwm_get_state(pwm, &state); |
204 | state.polarity = polarity; | |
205 | ret = pwm_apply_state(pwm, &state); | |
459a25af | 206 | mutex_unlock(&export->lock); |
76abbdde HS |
207 | |
208 | return ret ? : size; | |
209 | } | |
210 | ||
1a366fe9 LJ |
211 | static ssize_t capture_show(struct device *child, |
212 | struct device_attribute *attr, | |
213 | char *buf) | |
214 | { | |
215 | struct pwm_device *pwm = child_to_pwm_device(child); | |
216 | struct pwm_capture result; | |
217 | int ret; | |
218 | ||
219 | ret = pwm_capture(pwm, &result, jiffies_to_msecs(HZ)); | |
220 | if (ret) | |
221 | return ret; | |
222 | ||
223 | return sprintf(buf, "%u %u\n", result.period, result.duty_cycle); | |
224 | } | |
225 | ||
65cdc691 OS |
226 | static DEVICE_ATTR_RW(period); |
227 | static DEVICE_ATTR_RW(duty_cycle); | |
228 | static DEVICE_ATTR_RW(enable); | |
229 | static DEVICE_ATTR_RW(polarity); | |
1a366fe9 | 230 | static DEVICE_ATTR_RO(capture); |
76abbdde HS |
231 | |
232 | static struct attribute *pwm_attrs[] = { | |
233 | &dev_attr_period.attr, | |
234 | &dev_attr_duty_cycle.attr, | |
235 | &dev_attr_enable.attr, | |
236 | &dev_attr_polarity.attr, | |
1a366fe9 | 237 | &dev_attr_capture.attr, |
76abbdde HS |
238 | NULL |
239 | }; | |
6ca142ad | 240 | ATTRIBUTE_GROUPS(pwm); |
76abbdde HS |
241 | |
242 | static void pwm_export_release(struct device *child) | |
243 | { | |
244 | struct pwm_export *export = child_to_pwm_export(child); | |
245 | ||
246 | kfree(export); | |
247 | } | |
248 | ||
249 | static int pwm_export_child(struct device *parent, struct pwm_device *pwm) | |
250 | { | |
251 | struct pwm_export *export; | |
252 | int ret; | |
253 | ||
254 | if (test_and_set_bit(PWMF_EXPORTED, &pwm->flags)) | |
255 | return -EBUSY; | |
256 | ||
257 | export = kzalloc(sizeof(*export), GFP_KERNEL); | |
258 | if (!export) { | |
259 | clear_bit(PWMF_EXPORTED, &pwm->flags); | |
260 | return -ENOMEM; | |
261 | } | |
262 | ||
263 | export->pwm = pwm; | |
459a25af | 264 | mutex_init(&export->lock); |
76abbdde | 265 | |
7e5d1fd7 | 266 | export->child.class = parent->class; |
76abbdde HS |
267 | export->child.release = pwm_export_release; |
268 | export->child.parent = parent; | |
269 | export->child.devt = MKDEV(0, 0); | |
6ca142ad | 270 | export->child.groups = pwm_groups; |
76abbdde HS |
271 | dev_set_name(&export->child, "pwm%u", pwm->hwpwm); |
272 | ||
273 | ret = device_register(&export->child); | |
274 | if (ret) { | |
275 | clear_bit(PWMF_EXPORTED, &pwm->flags); | |
8bbf5b42 AY |
276 | put_device(&export->child); |
277 | export = NULL; | |
76abbdde HS |
278 | return ret; |
279 | } | |
280 | ||
281 | return 0; | |
282 | } | |
283 | ||
284 | static int pwm_unexport_match(struct device *child, void *data) | |
285 | { | |
286 | return child_to_pwm_device(child) == data; | |
287 | } | |
288 | ||
289 | static int pwm_unexport_child(struct device *parent, struct pwm_device *pwm) | |
290 | { | |
291 | struct device *child; | |
292 | ||
293 | if (!test_and_clear_bit(PWMF_EXPORTED, &pwm->flags)) | |
294 | return -ENODEV; | |
295 | ||
296 | child = device_find_child(parent, pwm, pwm_unexport_match); | |
297 | if (!child) | |
298 | return -ENODEV; | |
299 | ||
300 | /* for device_find_child() */ | |
301 | put_device(child); | |
302 | device_unregister(child); | |
303 | pwm_put(pwm); | |
304 | ||
305 | return 0; | |
306 | } | |
307 | ||
65cdc691 OS |
308 | static ssize_t export_store(struct device *parent, |
309 | struct device_attribute *attr, | |
310 | const char *buf, size_t len) | |
76abbdde HS |
311 | { |
312 | struct pwm_chip *chip = dev_get_drvdata(parent); | |
313 | struct pwm_device *pwm; | |
314 | unsigned int hwpwm; | |
315 | int ret; | |
316 | ||
317 | ret = kstrtouint(buf, 0, &hwpwm); | |
318 | if (ret < 0) | |
319 | return ret; | |
320 | ||
321 | if (hwpwm >= chip->npwm) | |
322 | return -ENODEV; | |
323 | ||
324 | pwm = pwm_request_from_chip(chip, hwpwm, "sysfs"); | |
325 | if (IS_ERR(pwm)) | |
326 | return PTR_ERR(pwm); | |
327 | ||
328 | ret = pwm_export_child(parent, pwm); | |
329 | if (ret < 0) | |
330 | pwm_put(pwm); | |
331 | ||
332 | return ret ? : len; | |
333 | } | |
65cdc691 | 334 | static DEVICE_ATTR_WO(export); |
76abbdde | 335 | |
65cdc691 OS |
336 | static ssize_t unexport_store(struct device *parent, |
337 | struct device_attribute *attr, | |
338 | const char *buf, size_t len) | |
76abbdde HS |
339 | { |
340 | struct pwm_chip *chip = dev_get_drvdata(parent); | |
341 | unsigned int hwpwm; | |
342 | int ret; | |
343 | ||
344 | ret = kstrtouint(buf, 0, &hwpwm); | |
345 | if (ret < 0) | |
346 | return ret; | |
347 | ||
348 | if (hwpwm >= chip->npwm) | |
349 | return -ENODEV; | |
350 | ||
351 | ret = pwm_unexport_child(parent, &chip->pwms[hwpwm]); | |
352 | ||
353 | return ret ? : len; | |
354 | } | |
65cdc691 | 355 | static DEVICE_ATTR_WO(unexport); |
76abbdde | 356 | |
9da01759 GKH |
357 | static ssize_t npwm_show(struct device *parent, struct device_attribute *attr, |
358 | char *buf) | |
76abbdde HS |
359 | { |
360 | const struct pwm_chip *chip = dev_get_drvdata(parent); | |
361 | ||
362 | return sprintf(buf, "%u\n", chip->npwm); | |
363 | } | |
9da01759 | 364 | static DEVICE_ATTR_RO(npwm); |
76abbdde | 365 | |
9da01759 GKH |
366 | static struct attribute *pwm_chip_attrs[] = { |
367 | &dev_attr_export.attr, | |
368 | &dev_attr_unexport.attr, | |
369 | &dev_attr_npwm.attr, | |
370 | NULL, | |
76abbdde | 371 | }; |
9da01759 | 372 | ATTRIBUTE_GROUPS(pwm_chip); |
76abbdde HS |
373 | |
374 | static struct class pwm_class = { | |
412820dd TR |
375 | .name = "pwm", |
376 | .owner = THIS_MODULE, | |
377 | .dev_groups = pwm_chip_groups, | |
76abbdde HS |
378 | }; |
379 | ||
380 | static int pwmchip_sysfs_match(struct device *parent, const void *data) | |
381 | { | |
382 | return dev_get_drvdata(parent) == data; | |
383 | } | |
384 | ||
385 | void pwmchip_sysfs_export(struct pwm_chip *chip) | |
386 | { | |
387 | struct device *parent; | |
388 | ||
389 | /* | |
390 | * If device_create() fails the pwm_chip is still usable by | |
391 | * the kernel its just not exported. | |
392 | */ | |
393 | parent = device_create(&pwm_class, chip->dev, MKDEV(0, 0), chip, | |
394 | "pwmchip%d", chip->base); | |
395 | if (IS_ERR(parent)) { | |
396 | dev_warn(chip->dev, | |
397 | "device_create failed for pwm_chip sysfs export\n"); | |
398 | } | |
399 | } | |
400 | ||
401 | void pwmchip_sysfs_unexport(struct pwm_chip *chip) | |
402 | { | |
403 | struct device *parent; | |
404 | ||
405 | parent = class_find_device(&pwm_class, NULL, chip, | |
406 | pwmchip_sysfs_match); | |
407 | if (parent) { | |
408 | /* for class_find_device() */ | |
409 | put_device(parent); | |
410 | device_unregister(parent); | |
411 | } | |
412 | } | |
413 | ||
0733424c DH |
414 | void pwmchip_sysfs_unexport_children(struct pwm_chip *chip) |
415 | { | |
416 | struct device *parent; | |
417 | unsigned int i; | |
418 | ||
419 | parent = class_find_device(&pwm_class, NULL, chip, | |
420 | pwmchip_sysfs_match); | |
421 | if (!parent) | |
422 | return; | |
423 | ||
424 | for (i = 0; i < chip->npwm; i++) { | |
425 | struct pwm_device *pwm = &chip->pwms[i]; | |
426 | ||
427 | if (test_bit(PWMF_EXPORTED, &pwm->flags)) | |
428 | pwm_unexport_child(parent, pwm); | |
429 | } | |
0e1614ac JH |
430 | |
431 | put_device(parent); | |
0733424c DH |
432 | } |
433 | ||
76abbdde HS |
434 | static int __init pwm_sysfs_init(void) |
435 | { | |
436 | return class_register(&pwm_class); | |
437 | } | |
438 | subsys_initcall(pwm_sysfs_init); |