xref: /linux/drivers/pwm/core.c (revision fd639726bf15fca8ee1a00dce8e0096d0ad9bd18)
1 /*
2  * Generic pwmlib implementation
3  *
4  * Copyright (C) 2011 Sascha Hauer <s.hauer@pengutronix.de>
5  * Copyright (C) 2011-2012 Avionic Design GmbH
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 as published by
9  *  the Free Software Foundation; either version 2, or (at your option)
10  *  any later version.
11  *
12  *  This program is distributed in the hope that it will be useful,
13  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
14  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  *  GNU General Public License for more details.
16  *
17  *  You should have received a copy of the GNU General Public License
18  *  along with this program; see the file COPYING.  If not, write to
19  *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
20  */
21 
22 #include <linux/module.h>
23 #include <linux/pwm.h>
24 #include <linux/radix-tree.h>
25 #include <linux/list.h>
26 #include <linux/mutex.h>
27 #include <linux/err.h>
28 #include <linux/slab.h>
29 #include <linux/device.h>
30 #include <linux/debugfs.h>
31 #include <linux/seq_file.h>
32 
33 #include <dt-bindings/pwm/pwm.h>
34 
35 #define MAX_PWMS 1024
36 
37 static DEFINE_MUTEX(pwm_lookup_lock);
38 static LIST_HEAD(pwm_lookup_list);
39 static DEFINE_MUTEX(pwm_lock);
40 static LIST_HEAD(pwm_chips);
41 static DECLARE_BITMAP(allocated_pwms, MAX_PWMS);
42 static RADIX_TREE(pwm_tree, GFP_KERNEL);
43 
44 static struct pwm_device *pwm_to_device(unsigned int pwm)
45 {
46 	return radix_tree_lookup(&pwm_tree, pwm);
47 }
48 
49 static int alloc_pwms(int pwm, unsigned int count)
50 {
51 	unsigned int from = 0;
52 	unsigned int start;
53 
54 	if (pwm >= MAX_PWMS)
55 		return -EINVAL;
56 
57 	if (pwm >= 0)
58 		from = pwm;
59 
60 	start = bitmap_find_next_zero_area(allocated_pwms, MAX_PWMS, from,
61 					   count, 0);
62 
63 	if (pwm >= 0 && start != pwm)
64 		return -EEXIST;
65 
66 	if (start + count > MAX_PWMS)
67 		return -ENOSPC;
68 
69 	return start;
70 }
71 
72 static void free_pwms(struct pwm_chip *chip)
73 {
74 	unsigned int i;
75 
76 	for (i = 0; i < chip->npwm; i++) {
77 		struct pwm_device *pwm = &chip->pwms[i];
78 
79 		radix_tree_delete(&pwm_tree, pwm->pwm);
80 	}
81 
82 	bitmap_clear(allocated_pwms, chip->base, chip->npwm);
83 
84 	kfree(chip->pwms);
85 	chip->pwms = NULL;
86 }
87 
88 static struct pwm_chip *pwmchip_find_by_name(const char *name)
89 {
90 	struct pwm_chip *chip;
91 
92 	if (!name)
93 		return NULL;
94 
95 	mutex_lock(&pwm_lock);
96 
97 	list_for_each_entry(chip, &pwm_chips, list) {
98 		const char *chip_name = dev_name(chip->dev);
99 
100 		if (chip_name && strcmp(chip_name, name) == 0) {
101 			mutex_unlock(&pwm_lock);
102 			return chip;
103 		}
104 	}
105 
106 	mutex_unlock(&pwm_lock);
107 
108 	return NULL;
109 }
110 
111 static int pwm_device_request(struct pwm_device *pwm, const char *label)
112 {
113 	int err;
114 
115 	if (test_bit(PWMF_REQUESTED, &pwm->flags))
116 		return -EBUSY;
117 
118 	if (!try_module_get(pwm->chip->ops->owner))
119 		return -ENODEV;
120 
121 	if (pwm->chip->ops->request) {
122 		err = pwm->chip->ops->request(pwm->chip, pwm);
123 		if (err) {
124 			module_put(pwm->chip->ops->owner);
125 			return err;
126 		}
127 	}
128 
129 	set_bit(PWMF_REQUESTED, &pwm->flags);
130 	pwm->label = label;
131 
132 	return 0;
133 }
134 
135 struct pwm_device *
136 of_pwm_xlate_with_flags(struct pwm_chip *pc, const struct of_phandle_args *args)
137 {
138 	struct pwm_device *pwm;
139 
140 	/* check, whether the driver supports a third cell for flags */
141 	if (pc->of_pwm_n_cells < 3)
142 		return ERR_PTR(-EINVAL);
143 
144 	/* flags in the third cell are optional */
145 	if (args->args_count < 2)
146 		return ERR_PTR(-EINVAL);
147 
148 	if (args->args[0] >= pc->npwm)
149 		return ERR_PTR(-EINVAL);
150 
151 	pwm = pwm_request_from_chip(pc, args->args[0], NULL);
152 	if (IS_ERR(pwm))
153 		return pwm;
154 
155 	pwm->args.period = args->args[1];
156 	pwm->args.polarity = PWM_POLARITY_NORMAL;
157 
158 	if (args->args_count > 2 && args->args[2] & PWM_POLARITY_INVERTED)
159 		pwm->args.polarity = PWM_POLARITY_INVERSED;
160 
161 	return pwm;
162 }
163 EXPORT_SYMBOL_GPL(of_pwm_xlate_with_flags);
164 
165 static struct pwm_device *
166 of_pwm_simple_xlate(struct pwm_chip *pc, const struct of_phandle_args *args)
167 {
168 	struct pwm_device *pwm;
169 
170 	/* sanity check driver support */
171 	if (pc->of_pwm_n_cells < 2)
172 		return ERR_PTR(-EINVAL);
173 
174 	/* all cells are required */
175 	if (args->args_count != pc->of_pwm_n_cells)
176 		return ERR_PTR(-EINVAL);
177 
178 	if (args->args[0] >= pc->npwm)
179 		return ERR_PTR(-EINVAL);
180 
181 	pwm = pwm_request_from_chip(pc, args->args[0], NULL);
182 	if (IS_ERR(pwm))
183 		return pwm;
184 
185 	pwm->args.period = args->args[1];
186 
187 	return pwm;
188 }
189 
190 static void of_pwmchip_add(struct pwm_chip *chip)
191 {
192 	if (!chip->dev || !chip->dev->of_node)
193 		return;
194 
195 	if (!chip->of_xlate) {
196 		chip->of_xlate = of_pwm_simple_xlate;
197 		chip->of_pwm_n_cells = 2;
198 	}
199 
200 	of_node_get(chip->dev->of_node);
201 }
202 
203 static void of_pwmchip_remove(struct pwm_chip *chip)
204 {
205 	if (chip->dev)
206 		of_node_put(chip->dev->of_node);
207 }
208 
209 /**
210  * pwm_set_chip_data() - set private chip data for a PWM
211  * @pwm: PWM device
212  * @data: pointer to chip-specific data
213  *
214  * Returns: 0 on success or a negative error code on failure.
215  */
216 int pwm_set_chip_data(struct pwm_device *pwm, void *data)
217 {
218 	if (!pwm)
219 		return -EINVAL;
220 
221 	pwm->chip_data = data;
222 
223 	return 0;
224 }
225 EXPORT_SYMBOL_GPL(pwm_set_chip_data);
226 
227 /**
228  * pwm_get_chip_data() - get private chip data for a PWM
229  * @pwm: PWM device
230  *
231  * Returns: A pointer to the chip-private data for the PWM device.
232  */
233 void *pwm_get_chip_data(struct pwm_device *pwm)
234 {
235 	return pwm ? pwm->chip_data : NULL;
236 }
237 EXPORT_SYMBOL_GPL(pwm_get_chip_data);
238 
239 static bool pwm_ops_check(const struct pwm_ops *ops)
240 {
241 	/* driver supports legacy, non-atomic operation */
242 	if (ops->config && ops->enable && ops->disable)
243 		return true;
244 
245 	/* driver supports atomic operation */
246 	if (ops->apply)
247 		return true;
248 
249 	return false;
250 }
251 
252 /**
253  * pwmchip_add_with_polarity() - register a new PWM chip
254  * @chip: the PWM chip to add
255  * @polarity: initial polarity of PWM channels
256  *
257  * Register a new PWM chip. If chip->base < 0 then a dynamically assigned base
258  * will be used. The initial polarity for all channels is specified by the
259  * @polarity parameter.
260  *
261  * Returns: 0 on success or a negative error code on failure.
262  */
263 int pwmchip_add_with_polarity(struct pwm_chip *chip,
264 			      enum pwm_polarity polarity)
265 {
266 	struct pwm_device *pwm;
267 	unsigned int i;
268 	int ret;
269 
270 	if (!chip || !chip->dev || !chip->ops || !chip->npwm)
271 		return -EINVAL;
272 
273 	if (!pwm_ops_check(chip->ops))
274 		return -EINVAL;
275 
276 	mutex_lock(&pwm_lock);
277 
278 	ret = alloc_pwms(chip->base, chip->npwm);
279 	if (ret < 0)
280 		goto out;
281 
282 	chip->pwms = kcalloc(chip->npwm, sizeof(*pwm), GFP_KERNEL);
283 	if (!chip->pwms) {
284 		ret = -ENOMEM;
285 		goto out;
286 	}
287 
288 	chip->base = ret;
289 
290 	for (i = 0; i < chip->npwm; i++) {
291 		pwm = &chip->pwms[i];
292 
293 		pwm->chip = chip;
294 		pwm->pwm = chip->base + i;
295 		pwm->hwpwm = i;
296 		pwm->state.polarity = polarity;
297 
298 		if (chip->ops->get_state)
299 			chip->ops->get_state(chip, pwm, &pwm->state);
300 
301 		radix_tree_insert(&pwm_tree, pwm->pwm, pwm);
302 	}
303 
304 	bitmap_set(allocated_pwms, chip->base, chip->npwm);
305 
306 	INIT_LIST_HEAD(&chip->list);
307 	list_add(&chip->list, &pwm_chips);
308 
309 	ret = 0;
310 
311 	if (IS_ENABLED(CONFIG_OF))
312 		of_pwmchip_add(chip);
313 
314 	pwmchip_sysfs_export(chip);
315 
316 out:
317 	mutex_unlock(&pwm_lock);
318 	return ret;
319 }
320 EXPORT_SYMBOL_GPL(pwmchip_add_with_polarity);
321 
322 /**
323  * pwmchip_add() - register a new PWM chip
324  * @chip: the PWM chip to add
325  *
326  * Register a new PWM chip. If chip->base < 0 then a dynamically assigned base
327  * will be used. The initial polarity for all channels is normal.
328  *
329  * Returns: 0 on success or a negative error code on failure.
330  */
331 int pwmchip_add(struct pwm_chip *chip)
332 {
333 	return pwmchip_add_with_polarity(chip, PWM_POLARITY_NORMAL);
334 }
335 EXPORT_SYMBOL_GPL(pwmchip_add);
336 
337 /**
338  * pwmchip_remove() - remove a PWM chip
339  * @chip: the PWM chip to remove
340  *
341  * Removes a PWM chip. This function may return busy if the PWM chip provides
342  * a PWM device that is still requested.
343  *
344  * Returns: 0 on success or a negative error code on failure.
345  */
346 int pwmchip_remove(struct pwm_chip *chip)
347 {
348 	unsigned int i;
349 	int ret = 0;
350 
351 	pwmchip_sysfs_unexport_children(chip);
352 
353 	mutex_lock(&pwm_lock);
354 
355 	for (i = 0; i < chip->npwm; i++) {
356 		struct pwm_device *pwm = &chip->pwms[i];
357 
358 		if (test_bit(PWMF_REQUESTED, &pwm->flags)) {
359 			ret = -EBUSY;
360 			goto out;
361 		}
362 	}
363 
364 	list_del_init(&chip->list);
365 
366 	if (IS_ENABLED(CONFIG_OF))
367 		of_pwmchip_remove(chip);
368 
369 	free_pwms(chip);
370 
371 	pwmchip_sysfs_unexport(chip);
372 
373 out:
374 	mutex_unlock(&pwm_lock);
375 	return ret;
376 }
377 EXPORT_SYMBOL_GPL(pwmchip_remove);
378 
379 /**
380  * pwm_request() - request a PWM device
381  * @pwm: global PWM device index
382  * @label: PWM device label
383  *
384  * This function is deprecated, use pwm_get() instead.
385  *
386  * Returns: A pointer to a PWM device or an ERR_PTR()-encoded error code on
387  * failure.
388  */
389 struct pwm_device *pwm_request(int pwm, const char *label)
390 {
391 	struct pwm_device *dev;
392 	int err;
393 
394 	if (pwm < 0 || pwm >= MAX_PWMS)
395 		return ERR_PTR(-EINVAL);
396 
397 	mutex_lock(&pwm_lock);
398 
399 	dev = pwm_to_device(pwm);
400 	if (!dev) {
401 		dev = ERR_PTR(-EPROBE_DEFER);
402 		goto out;
403 	}
404 
405 	err = pwm_device_request(dev, label);
406 	if (err < 0)
407 		dev = ERR_PTR(err);
408 
409 out:
410 	mutex_unlock(&pwm_lock);
411 
412 	return dev;
413 }
414 EXPORT_SYMBOL_GPL(pwm_request);
415 
416 /**
417  * pwm_request_from_chip() - request a PWM device relative to a PWM chip
418  * @chip: PWM chip
419  * @index: per-chip index of the PWM to request
420  * @label: a literal description string of this PWM
421  *
422  * Returns: A pointer to the PWM device at the given index of the given PWM
423  * chip. A negative error code is returned if the index is not valid for the
424  * specified PWM chip or if the PWM device cannot be requested.
425  */
426 struct pwm_device *pwm_request_from_chip(struct pwm_chip *chip,
427 					 unsigned int index,
428 					 const char *label)
429 {
430 	struct pwm_device *pwm;
431 	int err;
432 
433 	if (!chip || index >= chip->npwm)
434 		return ERR_PTR(-EINVAL);
435 
436 	mutex_lock(&pwm_lock);
437 	pwm = &chip->pwms[index];
438 
439 	err = pwm_device_request(pwm, label);
440 	if (err < 0)
441 		pwm = ERR_PTR(err);
442 
443 	mutex_unlock(&pwm_lock);
444 	return pwm;
445 }
446 EXPORT_SYMBOL_GPL(pwm_request_from_chip);
447 
448 /**
449  * pwm_free() - free a PWM device
450  * @pwm: PWM device
451  *
452  * This function is deprecated, use pwm_put() instead.
453  */
454 void pwm_free(struct pwm_device *pwm)
455 {
456 	pwm_put(pwm);
457 }
458 EXPORT_SYMBOL_GPL(pwm_free);
459 
460 /**
461  * pwm_apply_state() - atomically apply a new state to a PWM device
462  * @pwm: PWM device
463  * @state: new state to apply. This can be adjusted by the PWM driver
464  *	   if the requested config is not achievable, for example,
465  *	   ->duty_cycle and ->period might be approximated.
466  */
467 int pwm_apply_state(struct pwm_device *pwm, struct pwm_state *state)
468 {
469 	int err;
470 
471 	if (!pwm || !state || !state->period ||
472 	    state->duty_cycle > state->period)
473 		return -EINVAL;
474 
475 	if (!memcmp(state, &pwm->state, sizeof(*state)))
476 		return 0;
477 
478 	if (pwm->chip->ops->apply) {
479 		err = pwm->chip->ops->apply(pwm->chip, pwm, state);
480 		if (err)
481 			return err;
482 
483 		pwm->state = *state;
484 	} else {
485 		/*
486 		 * FIXME: restore the initial state in case of error.
487 		 */
488 		if (state->polarity != pwm->state.polarity) {
489 			if (!pwm->chip->ops->set_polarity)
490 				return -ENOTSUPP;
491 
492 			/*
493 			 * Changing the polarity of a running PWM is
494 			 * only allowed when the PWM driver implements
495 			 * ->apply().
496 			 */
497 			if (pwm->state.enabled) {
498 				pwm->chip->ops->disable(pwm->chip, pwm);
499 				pwm->state.enabled = false;
500 			}
501 
502 			err = pwm->chip->ops->set_polarity(pwm->chip, pwm,
503 							   state->polarity);
504 			if (err)
505 				return err;
506 
507 			pwm->state.polarity = state->polarity;
508 		}
509 
510 		if (state->period != pwm->state.period ||
511 		    state->duty_cycle != pwm->state.duty_cycle) {
512 			err = pwm->chip->ops->config(pwm->chip, pwm,
513 						     state->duty_cycle,
514 						     state->period);
515 			if (err)
516 				return err;
517 
518 			pwm->state.duty_cycle = state->duty_cycle;
519 			pwm->state.period = state->period;
520 		}
521 
522 		if (state->enabled != pwm->state.enabled) {
523 			if (state->enabled) {
524 				err = pwm->chip->ops->enable(pwm->chip, pwm);
525 				if (err)
526 					return err;
527 			} else {
528 				pwm->chip->ops->disable(pwm->chip, pwm);
529 			}
530 
531 			pwm->state.enabled = state->enabled;
532 		}
533 	}
534 
535 	return 0;
536 }
537 EXPORT_SYMBOL_GPL(pwm_apply_state);
538 
539 /**
540  * pwm_capture() - capture and report a PWM signal
541  * @pwm: PWM device
542  * @result: structure to fill with capture result
543  * @timeout: time to wait, in milliseconds, before giving up on capture
544  *
545  * Returns: 0 on success or a negative error code on failure.
546  */
547 int pwm_capture(struct pwm_device *pwm, struct pwm_capture *result,
548 		unsigned long timeout)
549 {
550 	int err;
551 
552 	if (!pwm || !pwm->chip->ops)
553 		return -EINVAL;
554 
555 	if (!pwm->chip->ops->capture)
556 		return -ENOSYS;
557 
558 	mutex_lock(&pwm_lock);
559 	err = pwm->chip->ops->capture(pwm->chip, pwm, result, timeout);
560 	mutex_unlock(&pwm_lock);
561 
562 	return err;
563 }
564 EXPORT_SYMBOL_GPL(pwm_capture);
565 
566 /**
567  * pwm_adjust_config() - adjust the current PWM config to the PWM arguments
568  * @pwm: PWM device
569  *
570  * This function will adjust the PWM config to the PWM arguments provided
571  * by the DT or PWM lookup table. This is particularly useful to adapt
572  * the bootloader config to the Linux one.
573  */
574 int pwm_adjust_config(struct pwm_device *pwm)
575 {
576 	struct pwm_state state;
577 	struct pwm_args pargs;
578 
579 	pwm_get_args(pwm, &pargs);
580 	pwm_get_state(pwm, &state);
581 
582 	/*
583 	 * If the current period is zero it means that either the PWM driver
584 	 * does not support initial state retrieval or the PWM has not yet
585 	 * been configured.
586 	 *
587 	 * In either case, we setup the new period and polarity, and assign a
588 	 * duty cycle of 0.
589 	 */
590 	if (!state.period) {
591 		state.duty_cycle = 0;
592 		state.period = pargs.period;
593 		state.polarity = pargs.polarity;
594 
595 		return pwm_apply_state(pwm, &state);
596 	}
597 
598 	/*
599 	 * Adjust the PWM duty cycle/period based on the period value provided
600 	 * in PWM args.
601 	 */
602 	if (pargs.period != state.period) {
603 		u64 dutycycle = (u64)state.duty_cycle * pargs.period;
604 
605 		do_div(dutycycle, state.period);
606 		state.duty_cycle = dutycycle;
607 		state.period = pargs.period;
608 	}
609 
610 	/*
611 	 * If the polarity changed, we should also change the duty cycle.
612 	 */
613 	if (pargs.polarity != state.polarity) {
614 		state.polarity = pargs.polarity;
615 		state.duty_cycle = state.period - state.duty_cycle;
616 	}
617 
618 	return pwm_apply_state(pwm, &state);
619 }
620 EXPORT_SYMBOL_GPL(pwm_adjust_config);
621 
622 static struct pwm_chip *of_node_to_pwmchip(struct device_node *np)
623 {
624 	struct pwm_chip *chip;
625 
626 	mutex_lock(&pwm_lock);
627 
628 	list_for_each_entry(chip, &pwm_chips, list)
629 		if (chip->dev && chip->dev->of_node == np) {
630 			mutex_unlock(&pwm_lock);
631 			return chip;
632 		}
633 
634 	mutex_unlock(&pwm_lock);
635 
636 	return ERR_PTR(-EPROBE_DEFER);
637 }
638 
639 /**
640  * of_pwm_get() - request a PWM via the PWM framework
641  * @np: device node to get the PWM from
642  * @con_id: consumer name
643  *
644  * Returns the PWM device parsed from the phandle and index specified in the
645  * "pwms" property of a device tree node or a negative error-code on failure.
646  * Values parsed from the device tree are stored in the returned PWM device
647  * object.
648  *
649  * If con_id is NULL, the first PWM device listed in the "pwms" property will
650  * be requested. Otherwise the "pwm-names" property is used to do a reverse
651  * lookup of the PWM index. This also means that the "pwm-names" property
652  * becomes mandatory for devices that look up the PWM device via the con_id
653  * parameter.
654  *
655  * Returns: A pointer to the requested PWM device or an ERR_PTR()-encoded
656  * error code on failure.
657  */
658 struct pwm_device *of_pwm_get(struct device_node *np, const char *con_id)
659 {
660 	struct pwm_device *pwm = NULL;
661 	struct of_phandle_args args;
662 	struct pwm_chip *pc;
663 	int index = 0;
664 	int err;
665 
666 	if (con_id) {
667 		index = of_property_match_string(np, "pwm-names", con_id);
668 		if (index < 0)
669 			return ERR_PTR(index);
670 	}
671 
672 	err = of_parse_phandle_with_args(np, "pwms", "#pwm-cells", index,
673 					 &args);
674 	if (err) {
675 		pr_err("%s(): can't parse \"pwms\" property\n", __func__);
676 		return ERR_PTR(err);
677 	}
678 
679 	pc = of_node_to_pwmchip(args.np);
680 	if (IS_ERR(pc)) {
681 		if (PTR_ERR(pc) != -EPROBE_DEFER)
682 			pr_err("%s(): PWM chip not found\n", __func__);
683 
684 		pwm = ERR_CAST(pc);
685 		goto put;
686 	}
687 
688 	pwm = pc->of_xlate(pc, &args);
689 	if (IS_ERR(pwm))
690 		goto put;
691 
692 	/*
693 	 * If a consumer name was not given, try to look it up from the
694 	 * "pwm-names" property if it exists. Otherwise use the name of
695 	 * the user device node.
696 	 */
697 	if (!con_id) {
698 		err = of_property_read_string_index(np, "pwm-names", index,
699 						    &con_id);
700 		if (err < 0)
701 			con_id = np->name;
702 	}
703 
704 	pwm->label = con_id;
705 
706 put:
707 	of_node_put(args.np);
708 
709 	return pwm;
710 }
711 EXPORT_SYMBOL_GPL(of_pwm_get);
712 
713 /**
714  * pwm_add_table() - register PWM device consumers
715  * @table: array of consumers to register
716  * @num: number of consumers in table
717  */
718 void pwm_add_table(struct pwm_lookup *table, size_t num)
719 {
720 	mutex_lock(&pwm_lookup_lock);
721 
722 	while (num--) {
723 		list_add_tail(&table->list, &pwm_lookup_list);
724 		table++;
725 	}
726 
727 	mutex_unlock(&pwm_lookup_lock);
728 }
729 
730 /**
731  * pwm_remove_table() - unregister PWM device consumers
732  * @table: array of consumers to unregister
733  * @num: number of consumers in table
734  */
735 void pwm_remove_table(struct pwm_lookup *table, size_t num)
736 {
737 	mutex_lock(&pwm_lookup_lock);
738 
739 	while (num--) {
740 		list_del(&table->list);
741 		table++;
742 	}
743 
744 	mutex_unlock(&pwm_lookup_lock);
745 }
746 
747 /**
748  * pwm_get() - look up and request a PWM device
749  * @dev: device for PWM consumer
750  * @con_id: consumer name
751  *
752  * Lookup is first attempted using DT. If the device was not instantiated from
753  * a device tree, a PWM chip and a relative index is looked up via a table
754  * supplied by board setup code (see pwm_add_table()).
755  *
756  * Once a PWM chip has been found the specified PWM device will be requested
757  * and is ready to be used.
758  *
759  * Returns: A pointer to the requested PWM device or an ERR_PTR()-encoded
760  * error code on failure.
761  */
762 struct pwm_device *pwm_get(struct device *dev, const char *con_id)
763 {
764 	const char *dev_id = dev ? dev_name(dev) : NULL;
765 	struct pwm_device *pwm;
766 	struct pwm_chip *chip;
767 	unsigned int best = 0;
768 	struct pwm_lookup *p, *chosen = NULL;
769 	unsigned int match;
770 	int err;
771 
772 	/* look up via DT first */
773 	if (IS_ENABLED(CONFIG_OF) && dev && dev->of_node)
774 		return of_pwm_get(dev->of_node, con_id);
775 
776 	/*
777 	 * We look up the provider in the static table typically provided by
778 	 * board setup code. We first try to lookup the consumer device by
779 	 * name. If the consumer device was passed in as NULL or if no match
780 	 * was found, we try to find the consumer by directly looking it up
781 	 * by name.
782 	 *
783 	 * If a match is found, the provider PWM chip is looked up by name
784 	 * and a PWM device is requested using the PWM device per-chip index.
785 	 *
786 	 * The lookup algorithm was shamelessly taken from the clock
787 	 * framework:
788 	 *
789 	 * We do slightly fuzzy matching here:
790 	 *  An entry with a NULL ID is assumed to be a wildcard.
791 	 *  If an entry has a device ID, it must match
792 	 *  If an entry has a connection ID, it must match
793 	 * Then we take the most specific entry - with the following order
794 	 * of precedence: dev+con > dev only > con only.
795 	 */
796 	mutex_lock(&pwm_lookup_lock);
797 
798 	list_for_each_entry(p, &pwm_lookup_list, list) {
799 		match = 0;
800 
801 		if (p->dev_id) {
802 			if (!dev_id || strcmp(p->dev_id, dev_id))
803 				continue;
804 
805 			match += 2;
806 		}
807 
808 		if (p->con_id) {
809 			if (!con_id || strcmp(p->con_id, con_id))
810 				continue;
811 
812 			match += 1;
813 		}
814 
815 		if (match > best) {
816 			chosen = p;
817 
818 			if (match != 3)
819 				best = match;
820 			else
821 				break;
822 		}
823 	}
824 
825 	mutex_unlock(&pwm_lookup_lock);
826 
827 	if (!chosen)
828 		return ERR_PTR(-ENODEV);
829 
830 	chip = pwmchip_find_by_name(chosen->provider);
831 
832 	/*
833 	 * If the lookup entry specifies a module, load the module and retry
834 	 * the PWM chip lookup. This can be used to work around driver load
835 	 * ordering issues if driver's can't be made to properly support the
836 	 * deferred probe mechanism.
837 	 */
838 	if (!chip && chosen->module) {
839 		err = request_module(chosen->module);
840 		if (err == 0)
841 			chip = pwmchip_find_by_name(chosen->provider);
842 	}
843 
844 	if (!chip)
845 		return ERR_PTR(-EPROBE_DEFER);
846 
847 	pwm = pwm_request_from_chip(chip, chosen->index, con_id ?: dev_id);
848 	if (IS_ERR(pwm))
849 		return pwm;
850 
851 	pwm->args.period = chosen->period;
852 	pwm->args.polarity = chosen->polarity;
853 
854 	return pwm;
855 }
856 EXPORT_SYMBOL_GPL(pwm_get);
857 
858 /**
859  * pwm_put() - release a PWM device
860  * @pwm: PWM device
861  */
862 void pwm_put(struct pwm_device *pwm)
863 {
864 	if (!pwm)
865 		return;
866 
867 	mutex_lock(&pwm_lock);
868 
869 	if (!test_and_clear_bit(PWMF_REQUESTED, &pwm->flags)) {
870 		pr_warn("PWM device already freed\n");
871 		goto out;
872 	}
873 
874 	if (pwm->chip->ops->free)
875 		pwm->chip->ops->free(pwm->chip, pwm);
876 
877 	pwm->label = NULL;
878 
879 	module_put(pwm->chip->ops->owner);
880 out:
881 	mutex_unlock(&pwm_lock);
882 }
883 EXPORT_SYMBOL_GPL(pwm_put);
884 
885 static void devm_pwm_release(struct device *dev, void *res)
886 {
887 	pwm_put(*(struct pwm_device **)res);
888 }
889 
890 /**
891  * devm_pwm_get() - resource managed pwm_get()
892  * @dev: device for PWM consumer
893  * @con_id: consumer name
894  *
895  * This function performs like pwm_get() but the acquired PWM device will
896  * automatically be released on driver detach.
897  *
898  * Returns: A pointer to the requested PWM device or an ERR_PTR()-encoded
899  * error code on failure.
900  */
901 struct pwm_device *devm_pwm_get(struct device *dev, const char *con_id)
902 {
903 	struct pwm_device **ptr, *pwm;
904 
905 	ptr = devres_alloc(devm_pwm_release, sizeof(*ptr), GFP_KERNEL);
906 	if (!ptr)
907 		return ERR_PTR(-ENOMEM);
908 
909 	pwm = pwm_get(dev, con_id);
910 	if (!IS_ERR(pwm)) {
911 		*ptr = pwm;
912 		devres_add(dev, ptr);
913 	} else {
914 		devres_free(ptr);
915 	}
916 
917 	return pwm;
918 }
919 EXPORT_SYMBOL_GPL(devm_pwm_get);
920 
921 /**
922  * devm_of_pwm_get() - resource managed of_pwm_get()
923  * @dev: device for PWM consumer
924  * @np: device node to get the PWM from
925  * @con_id: consumer name
926  *
927  * This function performs like of_pwm_get() but the acquired PWM device will
928  * automatically be released on driver detach.
929  *
930  * Returns: A pointer to the requested PWM device or an ERR_PTR()-encoded
931  * error code on failure.
932  */
933 struct pwm_device *devm_of_pwm_get(struct device *dev, struct device_node *np,
934 				   const char *con_id)
935 {
936 	struct pwm_device **ptr, *pwm;
937 
938 	ptr = devres_alloc(devm_pwm_release, sizeof(*ptr), GFP_KERNEL);
939 	if (!ptr)
940 		return ERR_PTR(-ENOMEM);
941 
942 	pwm = of_pwm_get(np, con_id);
943 	if (!IS_ERR(pwm)) {
944 		*ptr = pwm;
945 		devres_add(dev, ptr);
946 	} else {
947 		devres_free(ptr);
948 	}
949 
950 	return pwm;
951 }
952 EXPORT_SYMBOL_GPL(devm_of_pwm_get);
953 
954 static int devm_pwm_match(struct device *dev, void *res, void *data)
955 {
956 	struct pwm_device **p = res;
957 
958 	if (WARN_ON(!p || !*p))
959 		return 0;
960 
961 	return *p == data;
962 }
963 
964 /**
965  * devm_pwm_put() - resource managed pwm_put()
966  * @dev: device for PWM consumer
967  * @pwm: PWM device
968  *
969  * Release a PWM previously allocated using devm_pwm_get(). Calling this
970  * function is usually not needed because devm-allocated resources are
971  * automatically released on driver detach.
972  */
973 void devm_pwm_put(struct device *dev, struct pwm_device *pwm)
974 {
975 	WARN_ON(devres_release(dev, devm_pwm_release, devm_pwm_match, pwm));
976 }
977 EXPORT_SYMBOL_GPL(devm_pwm_put);
978 
979 #ifdef CONFIG_DEBUG_FS
980 static void pwm_dbg_show(struct pwm_chip *chip, struct seq_file *s)
981 {
982 	unsigned int i;
983 
984 	for (i = 0; i < chip->npwm; i++) {
985 		struct pwm_device *pwm = &chip->pwms[i];
986 		struct pwm_state state;
987 
988 		pwm_get_state(pwm, &state);
989 
990 		seq_printf(s, " pwm-%-3d (%-20.20s):", i, pwm->label);
991 
992 		if (test_bit(PWMF_REQUESTED, &pwm->flags))
993 			seq_puts(s, " requested");
994 
995 		if (state.enabled)
996 			seq_puts(s, " enabled");
997 
998 		seq_printf(s, " period: %u ns", state.period);
999 		seq_printf(s, " duty: %u ns", state.duty_cycle);
1000 		seq_printf(s, " polarity: %s",
1001 			   state.polarity ? "inverse" : "normal");
1002 
1003 		seq_puts(s, "\n");
1004 	}
1005 }
1006 
1007 static void *pwm_seq_start(struct seq_file *s, loff_t *pos)
1008 {
1009 	mutex_lock(&pwm_lock);
1010 	s->private = "";
1011 
1012 	return seq_list_start(&pwm_chips, *pos);
1013 }
1014 
1015 static void *pwm_seq_next(struct seq_file *s, void *v, loff_t *pos)
1016 {
1017 	s->private = "\n";
1018 
1019 	return seq_list_next(v, &pwm_chips, pos);
1020 }
1021 
1022 static void pwm_seq_stop(struct seq_file *s, void *v)
1023 {
1024 	mutex_unlock(&pwm_lock);
1025 }
1026 
1027 static int pwm_seq_show(struct seq_file *s, void *v)
1028 {
1029 	struct pwm_chip *chip = list_entry(v, struct pwm_chip, list);
1030 
1031 	seq_printf(s, "%s%s/%s, %d PWM device%s\n", (char *)s->private,
1032 		   chip->dev->bus ? chip->dev->bus->name : "no-bus",
1033 		   dev_name(chip->dev), chip->npwm,
1034 		   (chip->npwm != 1) ? "s" : "");
1035 
1036 	if (chip->ops->dbg_show)
1037 		chip->ops->dbg_show(chip, s);
1038 	else
1039 		pwm_dbg_show(chip, s);
1040 
1041 	return 0;
1042 }
1043 
1044 static const struct seq_operations pwm_seq_ops = {
1045 	.start = pwm_seq_start,
1046 	.next = pwm_seq_next,
1047 	.stop = pwm_seq_stop,
1048 	.show = pwm_seq_show,
1049 };
1050 
1051 static int pwm_seq_open(struct inode *inode, struct file *file)
1052 {
1053 	return seq_open(file, &pwm_seq_ops);
1054 }
1055 
1056 static const struct file_operations pwm_debugfs_ops = {
1057 	.owner = THIS_MODULE,
1058 	.open = pwm_seq_open,
1059 	.read = seq_read,
1060 	.llseek = seq_lseek,
1061 	.release = seq_release,
1062 };
1063 
1064 static int __init pwm_debugfs_init(void)
1065 {
1066 	debugfs_create_file("pwm", S_IFREG | S_IRUGO, NULL, NULL,
1067 			    &pwm_debugfs_ops);
1068 
1069 	return 0;
1070 }
1071 subsys_initcall(pwm_debugfs_init);
1072 #endif /* CONFIG_DEBUG_FS */
1073