Linux Audio

Check our new training course

Loading...
v5.9
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * Reset Controller framework
  4 *
  5 * Copyright 2013 Philipp Zabel, Pengutronix
  6 */
  7#include <linux/atomic.h>
 
  8#include <linux/device.h>
  9#include <linux/err.h>
 10#include <linux/export.h>
 11#include <linux/kernel.h>
 12#include <linux/kref.h>
 
 
 
 13#include <linux/module.h>
 14#include <linux/of.h>
 
 
 15#include <linux/reset.h>
 16#include <linux/reset-controller.h>
 17#include <linux/slab.h>
 18
 19static DEFINE_MUTEX(reset_list_mutex);
 20static LIST_HEAD(reset_controller_list);
 21
 22static DEFINE_MUTEX(reset_lookup_mutex);
 23static LIST_HEAD(reset_lookup_list);
 24
 
 
 
 
 
 25/**
 26 * struct reset_control - a reset control
 27 * @rcdev: a pointer to the reset controller device
 28 *         this reset control belongs to
 29 * @list: list entry for the rcdev's reset controller list
 30 * @id: ID of the reset controller in the reset
 31 *      controller device
 32 * @refcnt: Number of gets of this reset_control
 33 * @acquired: Only one reset_control may be acquired for a given rcdev and id.
 34 * @shared: Is this a shared (1), or an exclusive (0) reset_control?
 35 * @deassert_cnt: Number of times this reset line has been deasserted
 
 36 * @triggered_count: Number of times this reset line has been reset. Currently
 37 *                   only used for shared resets, which means that the value
 38 *                   will be either 0 or 1.
 39 */
 40struct reset_control {
 41	struct reset_controller_dev *rcdev;
 42	struct list_head list;
 43	unsigned int id;
 44	struct kref refcnt;
 45	bool acquired;
 46	bool shared;
 47	bool array;
 48	atomic_t deassert_count;
 49	atomic_t triggered_count;
 50};
 51
 52/**
 53 * struct reset_control_array - an array of reset controls
 54 * @base: reset control for compatibility with reset control API functions
 55 * @num_rstcs: number of reset controls
 56 * @rstc: array of reset controls
 57 */
 58struct reset_control_array {
 59	struct reset_control base;
 60	unsigned int num_rstcs;
 61	struct reset_control *rstc[];
 
 
 
 
 
 
 
 
 
 
 62};
 63
 64static const char *rcdev_name(struct reset_controller_dev *rcdev)
 65{
 66	if (rcdev->dev)
 67		return dev_name(rcdev->dev);
 68
 69	if (rcdev->of_node)
 70		return rcdev->of_node->full_name;
 71
 
 
 
 72	return NULL;
 73}
 74
 75/**
 76 * of_reset_simple_xlate - translate reset_spec to the reset line number
 77 * @rcdev: a pointer to the reset controller device
 78 * @reset_spec: reset line specifier as found in the device tree
 79 *
 80 * This static translation function is used by default if of_xlate in
 81 * :c:type:`reset_controller_dev` is not set. It is useful for all reset
 82 * controllers with 1:1 mapping, where reset lines can be indexed by number
 83 * without gaps.
 84 */
 85static int of_reset_simple_xlate(struct reset_controller_dev *rcdev,
 86			  const struct of_phandle_args *reset_spec)
 87{
 88	if (reset_spec->args[0] >= rcdev->nr_resets)
 89		return -EINVAL;
 90
 91	return reset_spec->args[0];
 92}
 93
 94/**
 95 * reset_controller_register - register a reset controller device
 96 * @rcdev: a pointer to the initialized reset controller device
 97 */
 98int reset_controller_register(struct reset_controller_dev *rcdev)
 99{
 
 
 
100	if (!rcdev->of_xlate) {
101		rcdev->of_reset_n_cells = 1;
102		rcdev->of_xlate = of_reset_simple_xlate;
103	}
104
105	INIT_LIST_HEAD(&rcdev->reset_control_head);
106
107	mutex_lock(&reset_list_mutex);
108	list_add(&rcdev->list, &reset_controller_list);
109	mutex_unlock(&reset_list_mutex);
110
111	return 0;
112}
113EXPORT_SYMBOL_GPL(reset_controller_register);
114
115/**
116 * reset_controller_unregister - unregister a reset controller device
117 * @rcdev: a pointer to the reset controller device
118 */
119void reset_controller_unregister(struct reset_controller_dev *rcdev)
120{
121	mutex_lock(&reset_list_mutex);
122	list_del(&rcdev->list);
123	mutex_unlock(&reset_list_mutex);
124}
125EXPORT_SYMBOL_GPL(reset_controller_unregister);
126
127static void devm_reset_controller_release(struct device *dev, void *res)
128{
129	reset_controller_unregister(*(struct reset_controller_dev **)res);
130}
131
132/**
133 * devm_reset_controller_register - resource managed reset_controller_register()
134 * @dev: device that is registering this reset controller
135 * @rcdev: a pointer to the initialized reset controller device
136 *
137 * Managed reset_controller_register(). For reset controllers registered by
138 * this function, reset_controller_unregister() is automatically called on
139 * driver detach. See reset_controller_register() for more information.
140 */
141int devm_reset_controller_register(struct device *dev,
142				   struct reset_controller_dev *rcdev)
143{
144	struct reset_controller_dev **rcdevp;
145	int ret;
146
147	rcdevp = devres_alloc(devm_reset_controller_release, sizeof(*rcdevp),
148			      GFP_KERNEL);
149	if (!rcdevp)
150		return -ENOMEM;
151
152	ret = reset_controller_register(rcdev);
153	if (ret) {
154		devres_free(rcdevp);
155		return ret;
156	}
157
158	*rcdevp = rcdev;
159	devres_add(dev, rcdevp);
160
161	return ret;
162}
163EXPORT_SYMBOL_GPL(devm_reset_controller_register);
164
165/**
166 * reset_controller_add_lookup - register a set of lookup entries
167 * @lookup: array of reset lookup entries
168 * @num_entries: number of entries in the lookup array
169 */
170void reset_controller_add_lookup(struct reset_control_lookup *lookup,
171				 unsigned int num_entries)
172{
173	struct reset_control_lookup *entry;
174	unsigned int i;
175
176	mutex_lock(&reset_lookup_mutex);
177	for (i = 0; i < num_entries; i++) {
178		entry = &lookup[i];
179
180		if (!entry->dev_id || !entry->provider) {
181			pr_warn("%s(): reset lookup entry badly specified, skipping\n",
182				__func__);
183			continue;
184		}
185
186		list_add_tail(&entry->list, &reset_lookup_list);
187	}
188	mutex_unlock(&reset_lookup_mutex);
189}
190EXPORT_SYMBOL_GPL(reset_controller_add_lookup);
191
192static inline struct reset_control_array *
193rstc_to_array(struct reset_control *rstc) {
194	return container_of(rstc, struct reset_control_array, base);
195}
196
197static int reset_control_array_reset(struct reset_control_array *resets)
198{
199	int ret, i;
200
201	for (i = 0; i < resets->num_rstcs; i++) {
202		ret = reset_control_reset(resets->rstc[i]);
203		if (ret)
204			return ret;
205	}
206
207	return 0;
208}
209
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
210static int reset_control_array_assert(struct reset_control_array *resets)
211{
212	int ret, i;
213
214	for (i = 0; i < resets->num_rstcs; i++) {
215		ret = reset_control_assert(resets->rstc[i]);
216		if (ret)
217			goto err;
218	}
219
220	return 0;
221
222err:
223	while (i--)
224		reset_control_deassert(resets->rstc[i]);
225	return ret;
226}
227
228static int reset_control_array_deassert(struct reset_control_array *resets)
229{
230	int ret, i;
231
232	for (i = 0; i < resets->num_rstcs; i++) {
233		ret = reset_control_deassert(resets->rstc[i]);
234		if (ret)
235			goto err;
236	}
237
238	return 0;
239
240err:
241	while (i--)
242		reset_control_assert(resets->rstc[i]);
243	return ret;
244}
245
246static int reset_control_array_acquire(struct reset_control_array *resets)
247{
248	unsigned int i;
249	int err;
250
251	for (i = 0; i < resets->num_rstcs; i++) {
252		err = reset_control_acquire(resets->rstc[i]);
253		if (err < 0)
254			goto release;
255	}
256
257	return 0;
258
259release:
260	while (i--)
261		reset_control_release(resets->rstc[i]);
262
263	return err;
264}
265
266static void reset_control_array_release(struct reset_control_array *resets)
267{
268	unsigned int i;
269
270	for (i = 0; i < resets->num_rstcs; i++)
271		reset_control_release(resets->rstc[i]);
272}
273
274static inline bool reset_control_is_array(struct reset_control *rstc)
275{
276	return rstc->array;
277}
278
279/**
280 * reset_control_reset - reset the controlled device
281 * @rstc: reset controller
282 *
283 * On a shared reset line the actual reset pulse is only triggered once for the
284 * lifetime of the reset_control instance: for all but the first caller this is
285 * a no-op.
286 * Consumers must not use reset_control_(de)assert on shared reset lines when
287 * reset_control_reset has been used.
288 *
289 * If rstc is NULL it is an optional reset and the function will just
290 * return 0.
291 */
292int reset_control_reset(struct reset_control *rstc)
293{
294	int ret;
295
296	if (!rstc)
297		return 0;
298
299	if (WARN_ON(IS_ERR(rstc)))
300		return -EINVAL;
301
302	if (reset_control_is_array(rstc))
303		return reset_control_array_reset(rstc_to_array(rstc));
304
305	if (!rstc->rcdev->ops->reset)
306		return -ENOTSUPP;
307
308	if (rstc->shared) {
309		if (WARN_ON(atomic_read(&rstc->deassert_count) != 0))
310			return -EINVAL;
311
312		if (atomic_inc_return(&rstc->triggered_count) != 1)
313			return 0;
314	} else {
315		if (!rstc->acquired)
316			return -EPERM;
317	}
318
319	ret = rstc->rcdev->ops->reset(rstc->rcdev, rstc->id);
320	if (rstc->shared && ret)
321		atomic_dec(&rstc->triggered_count);
322
323	return ret;
324}
325EXPORT_SYMBOL_GPL(reset_control_reset);
326
327/**
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
328 * reset_control_assert - asserts the reset line
329 * @rstc: reset controller
330 *
331 * Calling this on an exclusive reset controller guarantees that the reset
332 * will be asserted. When called on a shared reset controller the line may
333 * still be deasserted, as long as other users keep it so.
334 *
335 * For shared reset controls a driver cannot expect the hw's registers and
336 * internal state to be reset, but must be prepared for this to happen.
337 * Consumers must not use reset_control_reset on shared reset lines when
338 * reset_control_(de)assert has been used.
339 *
340 * If rstc is NULL it is an optional reset and the function will just
341 * return 0.
342 */
343int reset_control_assert(struct reset_control *rstc)
344{
345	if (!rstc)
346		return 0;
347
348	if (WARN_ON(IS_ERR(rstc)))
349		return -EINVAL;
350
351	if (reset_control_is_array(rstc))
352		return reset_control_array_assert(rstc_to_array(rstc));
353
354	if (rstc->shared) {
355		if (WARN_ON(atomic_read(&rstc->triggered_count) != 0))
356			return -EINVAL;
357
358		if (WARN_ON(atomic_read(&rstc->deassert_count) == 0))
359			return -EINVAL;
360
361		if (atomic_dec_return(&rstc->deassert_count) != 0)
362			return 0;
363
364		/*
365		 * Shared reset controls allow the reset line to be in any state
366		 * after this call, so doing nothing is a valid option.
367		 */
368		if (!rstc->rcdev->ops->assert)
369			return 0;
370	} else {
371		/*
372		 * If the reset controller does not implement .assert(), there
373		 * is no way to guarantee that the reset line is asserted after
374		 * this call.
375		 */
376		if (!rstc->rcdev->ops->assert)
377			return -ENOTSUPP;
378
379		if (!rstc->acquired) {
380			WARN(1, "reset %s (ID: %u) is not acquired\n",
381			     rcdev_name(rstc->rcdev), rstc->id);
382			return -EPERM;
383		}
384	}
385
386	return rstc->rcdev->ops->assert(rstc->rcdev, rstc->id);
387}
388EXPORT_SYMBOL_GPL(reset_control_assert);
389
390/**
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
391 * reset_control_deassert - deasserts the reset line
392 * @rstc: reset controller
393 *
394 * After calling this function, the reset is guaranteed to be deasserted.
395 * Consumers must not use reset_control_reset on shared reset lines when
396 * reset_control_(de)assert has been used.
397 *
398 * If rstc is NULL it is an optional reset and the function will just
399 * return 0.
400 */
401int reset_control_deassert(struct reset_control *rstc)
402{
403	if (!rstc)
404		return 0;
405
406	if (WARN_ON(IS_ERR(rstc)))
407		return -EINVAL;
408
409	if (reset_control_is_array(rstc))
410		return reset_control_array_deassert(rstc_to_array(rstc));
411
412	if (rstc->shared) {
413		if (WARN_ON(atomic_read(&rstc->triggered_count) != 0))
414			return -EINVAL;
415
416		if (atomic_inc_return(&rstc->deassert_count) != 1)
417			return 0;
418	} else {
419		if (!rstc->acquired) {
420			WARN(1, "reset %s (ID: %u) is not acquired\n",
421			     rcdev_name(rstc->rcdev), rstc->id);
422			return -EPERM;
423		}
424	}
425
426	/*
427	 * If the reset controller does not implement .deassert(), we assume
428	 * that it handles self-deasserting reset lines via .reset(). In that
429	 * case, the reset lines are deasserted by default. If that is not the
430	 * case, the reset controller driver should implement .deassert() and
431	 * return -ENOTSUPP.
432	 */
433	if (!rstc->rcdev->ops->deassert)
434		return 0;
435
436	return rstc->rcdev->ops->deassert(rstc->rcdev, rstc->id);
437}
438EXPORT_SYMBOL_GPL(reset_control_deassert);
439
440/**
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
441 * reset_control_status - returns a negative errno if not supported, a
442 * positive value if the reset line is asserted, or zero if the reset
443 * line is not asserted or if the desc is NULL (optional reset).
444 * @rstc: reset controller
445 */
446int reset_control_status(struct reset_control *rstc)
447{
448	if (!rstc)
449		return 0;
450
451	if (WARN_ON(IS_ERR(rstc)) || reset_control_is_array(rstc))
452		return -EINVAL;
453
454	if (rstc->rcdev->ops->status)
455		return rstc->rcdev->ops->status(rstc->rcdev, rstc->id);
456
457	return -ENOTSUPP;
458}
459EXPORT_SYMBOL_GPL(reset_control_status);
460
461/**
462 * reset_control_acquire() - acquires a reset control for exclusive use
463 * @rstc: reset control
464 *
465 * This is used to explicitly acquire a reset control for exclusive use. Note
466 * that exclusive resets are requested as acquired by default. In order for a
467 * second consumer to be able to control the reset, the first consumer has to
468 * release it first. Typically the easiest way to achieve this is to call the
469 * reset_control_get_exclusive_released() to obtain an instance of the reset
470 * control. Such reset controls are not acquired by default.
471 *
472 * Consumers implementing shared access to an exclusive reset need to follow
473 * a specific protocol in order to work together. Before consumers can change
474 * a reset they must acquire exclusive access using reset_control_acquire().
475 * After they are done operating the reset, they must release exclusive access
476 * with a call to reset_control_release(). Consumers are not granted exclusive
477 * access to the reset as long as another consumer hasn't released a reset.
478 *
479 * See also: reset_control_release()
480 */
481int reset_control_acquire(struct reset_control *rstc)
482{
483	struct reset_control *rc;
484
485	if (!rstc)
486		return 0;
487
488	if (WARN_ON(IS_ERR(rstc)))
489		return -EINVAL;
490
491	if (reset_control_is_array(rstc))
492		return reset_control_array_acquire(rstc_to_array(rstc));
493
494	mutex_lock(&reset_list_mutex);
495
496	if (rstc->acquired) {
497		mutex_unlock(&reset_list_mutex);
498		return 0;
499	}
500
501	list_for_each_entry(rc, &rstc->rcdev->reset_control_head, list) {
502		if (rstc != rc && rstc->id == rc->id) {
503			if (rc->acquired) {
504				mutex_unlock(&reset_list_mutex);
505				return -EBUSY;
506			}
507		}
508	}
509
510	rstc->acquired = true;
511
512	mutex_unlock(&reset_list_mutex);
513	return 0;
514}
515EXPORT_SYMBOL_GPL(reset_control_acquire);
516
517/**
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
518 * reset_control_release() - releases exclusive access to a reset control
519 * @rstc: reset control
520 *
521 * Releases exclusive access right to a reset control previously obtained by a
522 * call to reset_control_acquire(). Until a consumer calls this function, no
523 * other consumers will be granted exclusive access.
524 *
525 * See also: reset_control_acquire()
526 */
527void reset_control_release(struct reset_control *rstc)
528{
529	if (!rstc || WARN_ON(IS_ERR(rstc)))
530		return;
531
532	if (reset_control_is_array(rstc))
533		reset_control_array_release(rstc_to_array(rstc));
534	else
535		rstc->acquired = false;
536}
537EXPORT_SYMBOL_GPL(reset_control_release);
538
539static struct reset_control *__reset_control_get_internal(
540				struct reset_controller_dev *rcdev,
541				unsigned int index, bool shared, bool acquired)
 
 
 
 
 
 
 
 
 
542{
 
 
 
 
 
 
 
 
 
 
 
 
 
543	struct reset_control *rstc;
544
545	lockdep_assert_held(&reset_list_mutex);
546
 
 
 
 
 
547	list_for_each_entry(rstc, &rcdev->reset_control_head, list) {
548		if (rstc->id == index) {
549			/*
550			 * Allow creating a secondary exclusive reset_control
551			 * that is initially not acquired for an already
552			 * controlled reset line.
553			 */
554			if (!rstc->shared && !shared && !acquired)
555				break;
556
557			if (WARN_ON(!rstc->shared || !shared))
558				return ERR_PTR(-EBUSY);
559
560			kref_get(&rstc->refcnt);
561			return rstc;
562		}
563	}
564
565	rstc = kzalloc(sizeof(*rstc), GFP_KERNEL);
566	if (!rstc)
567		return ERR_PTR(-ENOMEM);
568
569	try_module_get(rcdev->owner);
 
 
 
570
571	rstc->rcdev = rcdev;
572	list_add(&rstc->list, &rcdev->reset_control_head);
573	rstc->id = index;
574	kref_init(&rstc->refcnt);
575	rstc->acquired = acquired;
576	rstc->shared = shared;
 
577
578	return rstc;
579}
580
581static void __reset_control_release(struct kref *kref)
582{
583	struct reset_control *rstc = container_of(kref, struct reset_control,
584						  refcnt);
585
586	lockdep_assert_held(&reset_list_mutex);
587
588	module_put(rstc->rcdev->owner);
589
590	list_del(&rstc->list);
 
591	kfree(rstc);
592}
593
594static void __reset_control_put_internal(struct reset_control *rstc)
595{
596	lockdep_assert_held(&reset_list_mutex);
597
 
 
 
598	kref_put(&rstc->refcnt, __reset_control_release);
599}
600
601struct reset_control *__of_reset_control_get(struct device_node *node,
602				     const char *id, int index, bool shared,
603				     bool optional, bool acquired)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
604{
 
 
605	struct reset_control *rstc;
606	struct reset_controller_dev *r, *rcdev;
607	struct of_phandle_args args;
608	int rstc_id;
609	int ret;
610
611	if (!node)
612		return ERR_PTR(-EINVAL);
613
614	if (id) {
615		index = of_property_match_string(node,
616						 "reset-names", id);
617		if (index == -EILSEQ)
618			return ERR_PTR(index);
619		if (index < 0)
620			return optional ? NULL : ERR_PTR(-ENOENT);
621	}
622
623	ret = of_parse_phandle_with_args(node, "resets", "#reset-cells",
624					 index, &args);
625	if (ret == -EINVAL)
626		return ERR_PTR(ret);
627	if (ret)
628		return optional ? NULL : ERR_PTR(ret);
 
629
630	mutex_lock(&reset_list_mutex);
631	rcdev = NULL;
632	list_for_each_entry(r, &reset_controller_list, list) {
633		if (args.np == r->of_node) {
634			rcdev = r;
635			break;
 
 
 
 
 
 
 
 
 
636		}
637	}
638
 
 
639	if (!rcdev) {
640		rstc = ERR_PTR(-EPROBE_DEFER);
641		goto out;
642	}
643
644	if (WARN_ON(args.args_count != rcdev->of_reset_n_cells)) {
645		rstc = ERR_PTR(-EINVAL);
646		goto out;
647	}
648
649	rstc_id = rcdev->of_xlate(rcdev, &args);
650	if (rstc_id < 0) {
651		rstc = ERR_PTR(rstc_id);
652		goto out;
653	}
654
 
 
655	/* reset_list_mutex also protects the rcdev's reset_control list */
656	rstc = __reset_control_get_internal(rcdev, rstc_id, shared, acquired);
657
658out:
659	mutex_unlock(&reset_list_mutex);
 
660	of_node_put(args.np);
661
662	return rstc;
663}
664EXPORT_SYMBOL_GPL(__of_reset_control_get);
665
666static struct reset_controller_dev *
667__reset_controller_by_name(const char *name)
668{
669	struct reset_controller_dev *rcdev;
670
671	lockdep_assert_held(&reset_list_mutex);
672
673	list_for_each_entry(rcdev, &reset_controller_list, list) {
674		if (!rcdev->dev)
675			continue;
676
677		if (!strcmp(name, dev_name(rcdev->dev)))
678			return rcdev;
679	}
680
681	return NULL;
682}
683
684static struct reset_control *
685__reset_control_get_from_lookup(struct device *dev, const char *con_id,
686				bool shared, bool optional, bool acquired)
687{
 
688	const struct reset_control_lookup *lookup;
689	struct reset_controller_dev *rcdev;
690	const char *dev_id = dev_name(dev);
691	struct reset_control *rstc = NULL;
692
693	mutex_lock(&reset_lookup_mutex);
694
695	list_for_each_entry(lookup, &reset_lookup_list, list) {
696		if (strcmp(lookup->dev_id, dev_id))
697			continue;
698
699		if ((!con_id && !lookup->con_id) ||
700		    ((con_id && lookup->con_id) &&
701		     !strcmp(con_id, lookup->con_id))) {
702			mutex_lock(&reset_list_mutex);
703			rcdev = __reset_controller_by_name(lookup->provider);
704			if (!rcdev) {
705				mutex_unlock(&reset_list_mutex);
706				mutex_unlock(&reset_lookup_mutex);
707				/* Reset provider may not be ready yet. */
708				return ERR_PTR(-EPROBE_DEFER);
709			}
710
 
 
711			rstc = __reset_control_get_internal(rcdev,
712							    lookup->index,
713							    shared, acquired);
714			mutex_unlock(&reset_list_mutex);
715			break;
716		}
717	}
718
719	mutex_unlock(&reset_lookup_mutex);
720
721	if (!rstc)
722		return optional ? NULL : ERR_PTR(-ENOENT);
723
724	return rstc;
725}
726
727struct reset_control *__reset_control_get(struct device *dev, const char *id,
728					  int index, bool shared, bool optional,
729					  bool acquired)
730{
 
 
 
731	if (WARN_ON(shared && acquired))
732		return ERR_PTR(-EINVAL);
733
734	if (dev->of_node)
735		return __of_reset_control_get(dev->of_node, id, index, shared,
736					      optional, acquired);
737
738	return __reset_control_get_from_lookup(dev, id, shared, optional,
739					       acquired);
740}
741EXPORT_SYMBOL_GPL(__reset_control_get);
742
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
743static void reset_control_array_put(struct reset_control_array *resets)
744{
745	int i;
746
747	mutex_lock(&reset_list_mutex);
748	for (i = 0; i < resets->num_rstcs; i++)
749		__reset_control_put_internal(resets->rstc[i]);
750	mutex_unlock(&reset_list_mutex);
751	kfree(resets);
752}
753
754/**
755 * reset_control_put - free the reset controller
756 * @rstc: reset controller
757 */
758void reset_control_put(struct reset_control *rstc)
759{
760	if (IS_ERR_OR_NULL(rstc))
761		return;
762
763	if (reset_control_is_array(rstc)) {
764		reset_control_array_put(rstc_to_array(rstc));
765		return;
766	}
767
768	mutex_lock(&reset_list_mutex);
769	__reset_control_put_internal(rstc);
770	mutex_unlock(&reset_list_mutex);
771}
772EXPORT_SYMBOL_GPL(reset_control_put);
773
 
 
 
 
 
 
 
 
 
 
 
 
 
 
774static void devm_reset_control_release(struct device *dev, void *res)
775{
776	reset_control_put(*(struct reset_control **)res);
777}
778
779struct reset_control *__devm_reset_control_get(struct device *dev,
780				     const char *id, int index, bool shared,
781				     bool optional, bool acquired)
 
 
 
 
 
 
 
 
782{
783	struct reset_control **ptr, *rstc;
 
784
785	ptr = devres_alloc(devm_reset_control_release, sizeof(*ptr),
 
786			   GFP_KERNEL);
787	if (!ptr)
788		return ERR_PTR(-ENOMEM);
789
790	rstc = __reset_control_get(dev, id, index, shared, optional, acquired);
 
 
791	if (IS_ERR_OR_NULL(rstc)) {
792		devres_free(ptr);
793		return rstc;
794	}
795
 
 
 
 
 
 
 
 
 
 
 
796	*ptr = rstc;
797	devres_add(dev, ptr);
798
799	return rstc;
800}
801EXPORT_SYMBOL_GPL(__devm_reset_control_get);
802
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
803/**
804 * device_reset - find reset controller associated with the device
805 *                and perform reset
806 * @dev: device to be reset by the controller
807 * @optional: whether it is optional to reset the device
808 *
809 * Convenience wrapper for __reset_control_get() and reset_control_reset().
810 * This is useful for the common case of devices with single, dedicated reset
811 * lines.
812 */
813int __device_reset(struct device *dev, bool optional)
814{
 
815	struct reset_control *rstc;
816	int ret;
817
818	rstc = __reset_control_get(dev, NULL, 0, 0, optional, true);
 
 
 
 
 
 
 
 
 
 
 
 
 
819	if (IS_ERR(rstc))
820		return PTR_ERR(rstc);
821
822	ret = reset_control_reset(rstc);
823
824	reset_control_put(rstc);
825
826	return ret;
827}
828EXPORT_SYMBOL_GPL(__device_reset);
829
830/*
831 * APIs to manage an array of reset controls.
832 */
833
834/**
835 * of_reset_control_get_count - Count number of resets available with a device
836 *
837 * @node: device node that contains 'resets'.
838 *
839 * Returns positive reset count on success, or error number on failure and
840 * on count being zero.
841 */
842static int of_reset_control_get_count(struct device_node *node)
843{
844	int count;
845
846	if (!node)
847		return -EINVAL;
848
849	count = of_count_phandle_with_args(node, "resets", "#reset-cells");
850	if (count == 0)
851		count = -ENOENT;
852
853	return count;
854}
855
856/**
857 * of_reset_control_array_get - Get a list of reset controls using
858 *				device node.
859 *
860 * @np: device node for the device that requests the reset controls array
861 * @shared: whether reset controls are shared or not
862 * @optional: whether it is optional to get the reset controls
863 * @acquired: only one reset control may be acquired for a given controller
864 *            and ID
865 *
866 * Returns pointer to allocated reset_control on success or error on failure
867 */
868struct reset_control *
869of_reset_control_array_get(struct device_node *np, bool shared, bool optional,
870			   bool acquired)
871{
 
872	struct reset_control_array *resets;
873	struct reset_control *rstc;
874	int num, i;
875
876	num = of_reset_control_get_count(np);
877	if (num < 0)
878		return optional ? NULL : ERR_PTR(num);
879
880	resets = kzalloc(struct_size(resets, rstc, num), GFP_KERNEL);
881	if (!resets)
882		return ERR_PTR(-ENOMEM);
 
883
884	for (i = 0; i < num; i++) {
885		rstc = __of_reset_control_get(np, NULL, i, shared, optional,
886					      acquired);
887		if (IS_ERR(rstc))
888			goto err_rst;
889		resets->rstc[i] = rstc;
890	}
891	resets->num_rstcs = num;
892	resets->base.array = true;
893
894	return &resets->base;
895
896err_rst:
897	mutex_lock(&reset_list_mutex);
898	while (--i >= 0)
899		__reset_control_put_internal(resets->rstc[i]);
900	mutex_unlock(&reset_list_mutex);
901
902	kfree(resets);
903
904	return rstc;
905}
906EXPORT_SYMBOL_GPL(of_reset_control_array_get);
907
908/**
909 * devm_reset_control_array_get - Resource managed reset control array get
910 *
911 * @dev: device that requests the list of reset controls
912 * @shared: whether reset controls are shared or not
913 * @optional: whether it is optional to get the reset controls
914 *
915 * The reset control array APIs are intended for a list of resets
916 * that just have to be asserted or deasserted, without any
917 * requirements on the order.
918 *
919 * Returns pointer to allocated reset_control on success or error on failure
920 */
921struct reset_control *
922devm_reset_control_array_get(struct device *dev, bool shared, bool optional)
923{
924	struct reset_control **ptr, *rstc;
925
926	ptr = devres_alloc(devm_reset_control_release, sizeof(*ptr),
927			   GFP_KERNEL);
928	if (!ptr)
929		return ERR_PTR(-ENOMEM);
930
931	rstc = of_reset_control_array_get(dev->of_node, shared, optional, true);
932	if (IS_ERR_OR_NULL(rstc)) {
933		devres_free(ptr);
934		return rstc;
935	}
936
937	*ptr = rstc;
938	devres_add(dev, ptr);
939
940	return rstc;
941}
942EXPORT_SYMBOL_GPL(devm_reset_control_array_get);
943
944static int reset_control_get_count_from_lookup(struct device *dev)
945{
946	const struct reset_control_lookup *lookup;
947	const char *dev_id;
948	int count = 0;
949
950	if (!dev)
951		return -EINVAL;
952
953	dev_id = dev_name(dev);
954	mutex_lock(&reset_lookup_mutex);
955
956	list_for_each_entry(lookup, &reset_lookup_list, list) {
957		if (!strcmp(lookup->dev_id, dev_id))
958			count++;
959	}
960
961	mutex_unlock(&reset_lookup_mutex);
962
963	if (count == 0)
964		count = -ENOENT;
965
966	return count;
967}
968
969/**
970 * reset_control_get_count - Count number of resets available with a device
971 *
972 * @dev: device for which to return the number of resets
973 *
974 * Returns positive reset count on success, or error number on failure and
975 * on count being zero.
976 */
977int reset_control_get_count(struct device *dev)
978{
979	if (dev->of_node)
980		return of_reset_control_get_count(dev->of_node);
981
982	return reset_control_get_count_from_lookup(dev);
983}
984EXPORT_SYMBOL_GPL(reset_control_get_count);
v6.13.7
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 * Reset Controller framework
   4 *
   5 * Copyright 2013 Philipp Zabel, Pengutronix
   6 */
   7#include <linux/atomic.h>
   8#include <linux/cleanup.h>
   9#include <linux/device.h>
  10#include <linux/err.h>
  11#include <linux/export.h>
  12#include <linux/kernel.h>
  13#include <linux/kref.h>
  14#include <linux/gpio/driver.h>
  15#include <linux/gpio/machine.h>
  16#include <linux/idr.h>
  17#include <linux/module.h>
  18#include <linux/of.h>
  19#include <linux/acpi.h>
  20#include <linux/platform_device.h>
  21#include <linux/reset.h>
  22#include <linux/reset-controller.h>
  23#include <linux/slab.h>
  24
  25static DEFINE_MUTEX(reset_list_mutex);
  26static LIST_HEAD(reset_controller_list);
  27
  28static DEFINE_MUTEX(reset_lookup_mutex);
  29static LIST_HEAD(reset_lookup_list);
  30
  31/* Protects reset_gpio_lookup_list */
  32static DEFINE_MUTEX(reset_gpio_lookup_mutex);
  33static LIST_HEAD(reset_gpio_lookup_list);
  34static DEFINE_IDA(reset_gpio_ida);
  35
  36/**
  37 * struct reset_control - a reset control
  38 * @rcdev: a pointer to the reset controller device
  39 *         this reset control belongs to
  40 * @list: list entry for the rcdev's reset controller list
  41 * @id: ID of the reset controller in the reset
  42 *      controller device
  43 * @refcnt: Number of gets of this reset_control
  44 * @acquired: Only one reset_control may be acquired for a given rcdev and id.
  45 * @shared: Is this a shared (1), or an exclusive (0) reset_control?
  46 * @array: Is this an array of reset controls (1)?
  47 * @deassert_count: Number of times this reset line has been deasserted
  48 * @triggered_count: Number of times this reset line has been reset. Currently
  49 *                   only used for shared resets, which means that the value
  50 *                   will be either 0 or 1.
  51 */
  52struct reset_control {
  53	struct reset_controller_dev *rcdev;
  54	struct list_head list;
  55	unsigned int id;
  56	struct kref refcnt;
  57	bool acquired;
  58	bool shared;
  59	bool array;
  60	atomic_t deassert_count;
  61	atomic_t triggered_count;
  62};
  63
  64/**
  65 * struct reset_control_array - an array of reset controls
  66 * @base: reset control for compatibility with reset control API functions
  67 * @num_rstcs: number of reset controls
  68 * @rstc: array of reset controls
  69 */
  70struct reset_control_array {
  71	struct reset_control base;
  72	unsigned int num_rstcs;
  73	struct reset_control *rstc[] __counted_by(num_rstcs);
  74};
  75
  76/**
  77 * struct reset_gpio_lookup - lookup key for ad-hoc created reset-gpio devices
  78 * @of_args: phandle to the reset controller with all the args like GPIO number
  79 * @list: list entry for the reset_gpio_lookup_list
  80 */
  81struct reset_gpio_lookup {
  82	struct of_phandle_args of_args;
  83	struct list_head list;
  84};
  85
  86static const char *rcdev_name(struct reset_controller_dev *rcdev)
  87{
  88	if (rcdev->dev)
  89		return dev_name(rcdev->dev);
  90
  91	if (rcdev->of_node)
  92		return rcdev->of_node->full_name;
  93
  94	if (rcdev->of_args)
  95		return rcdev->of_args->np->full_name;
  96
  97	return NULL;
  98}
  99
 100/**
 101 * of_reset_simple_xlate - translate reset_spec to the reset line number
 102 * @rcdev: a pointer to the reset controller device
 103 * @reset_spec: reset line specifier as found in the device tree
 104 *
 105 * This static translation function is used by default if of_xlate in
 106 * :c:type:`reset_controller_dev` is not set. It is useful for all reset
 107 * controllers with 1:1 mapping, where reset lines can be indexed by number
 108 * without gaps.
 109 */
 110static int of_reset_simple_xlate(struct reset_controller_dev *rcdev,
 111				 const struct of_phandle_args *reset_spec)
 112{
 113	if (reset_spec->args[0] >= rcdev->nr_resets)
 114		return -EINVAL;
 115
 116	return reset_spec->args[0];
 117}
 118
 119/**
 120 * reset_controller_register - register a reset controller device
 121 * @rcdev: a pointer to the initialized reset controller device
 122 */
 123int reset_controller_register(struct reset_controller_dev *rcdev)
 124{
 125	if (rcdev->of_node && rcdev->of_args)
 126		return -EINVAL;
 127
 128	if (!rcdev->of_xlate) {
 129		rcdev->of_reset_n_cells = 1;
 130		rcdev->of_xlate = of_reset_simple_xlate;
 131	}
 132
 133	INIT_LIST_HEAD(&rcdev->reset_control_head);
 134
 135	mutex_lock(&reset_list_mutex);
 136	list_add(&rcdev->list, &reset_controller_list);
 137	mutex_unlock(&reset_list_mutex);
 138
 139	return 0;
 140}
 141EXPORT_SYMBOL_GPL(reset_controller_register);
 142
 143/**
 144 * reset_controller_unregister - unregister a reset controller device
 145 * @rcdev: a pointer to the reset controller device
 146 */
 147void reset_controller_unregister(struct reset_controller_dev *rcdev)
 148{
 149	mutex_lock(&reset_list_mutex);
 150	list_del(&rcdev->list);
 151	mutex_unlock(&reset_list_mutex);
 152}
 153EXPORT_SYMBOL_GPL(reset_controller_unregister);
 154
 155static void devm_reset_controller_release(struct device *dev, void *res)
 156{
 157	reset_controller_unregister(*(struct reset_controller_dev **)res);
 158}
 159
 160/**
 161 * devm_reset_controller_register - resource managed reset_controller_register()
 162 * @dev: device that is registering this reset controller
 163 * @rcdev: a pointer to the initialized reset controller device
 164 *
 165 * Managed reset_controller_register(). For reset controllers registered by
 166 * this function, reset_controller_unregister() is automatically called on
 167 * driver detach. See reset_controller_register() for more information.
 168 */
 169int devm_reset_controller_register(struct device *dev,
 170				   struct reset_controller_dev *rcdev)
 171{
 172	struct reset_controller_dev **rcdevp;
 173	int ret;
 174
 175	rcdevp = devres_alloc(devm_reset_controller_release, sizeof(*rcdevp),
 176			      GFP_KERNEL);
 177	if (!rcdevp)
 178		return -ENOMEM;
 179
 180	ret = reset_controller_register(rcdev);
 181	if (ret) {
 182		devres_free(rcdevp);
 183		return ret;
 184	}
 185
 186	*rcdevp = rcdev;
 187	devres_add(dev, rcdevp);
 188
 189	return ret;
 190}
 191EXPORT_SYMBOL_GPL(devm_reset_controller_register);
 192
 193/**
 194 * reset_controller_add_lookup - register a set of lookup entries
 195 * @lookup: array of reset lookup entries
 196 * @num_entries: number of entries in the lookup array
 197 */
 198void reset_controller_add_lookup(struct reset_control_lookup *lookup,
 199				 unsigned int num_entries)
 200{
 201	struct reset_control_lookup *entry;
 202	unsigned int i;
 203
 204	mutex_lock(&reset_lookup_mutex);
 205	for (i = 0; i < num_entries; i++) {
 206		entry = &lookup[i];
 207
 208		if (!entry->dev_id || !entry->provider) {
 209			pr_warn("%s(): reset lookup entry badly specified, skipping\n",
 210				__func__);
 211			continue;
 212		}
 213
 214		list_add_tail(&entry->list, &reset_lookup_list);
 215	}
 216	mutex_unlock(&reset_lookup_mutex);
 217}
 218EXPORT_SYMBOL_GPL(reset_controller_add_lookup);
 219
 220static inline struct reset_control_array *
 221rstc_to_array(struct reset_control *rstc) {
 222	return container_of(rstc, struct reset_control_array, base);
 223}
 224
 225static int reset_control_array_reset(struct reset_control_array *resets)
 226{
 227	int ret, i;
 228
 229	for (i = 0; i < resets->num_rstcs; i++) {
 230		ret = reset_control_reset(resets->rstc[i]);
 231		if (ret)
 232			return ret;
 233	}
 234
 235	return 0;
 236}
 237
 238static int reset_control_array_rearm(struct reset_control_array *resets)
 239{
 240	struct reset_control *rstc;
 241	int i;
 242
 243	for (i = 0; i < resets->num_rstcs; i++) {
 244		rstc = resets->rstc[i];
 245
 246		if (!rstc)
 247			continue;
 248
 249		if (WARN_ON(IS_ERR(rstc)))
 250			return -EINVAL;
 251
 252		if (rstc->shared) {
 253			if (WARN_ON(atomic_read(&rstc->deassert_count) != 0))
 254				return -EINVAL;
 255		} else {
 256			if (!rstc->acquired)
 257				return -EPERM;
 258		}
 259	}
 260
 261	for (i = 0; i < resets->num_rstcs; i++) {
 262		rstc = resets->rstc[i];
 263
 264		if (rstc && rstc->shared)
 265			WARN_ON(atomic_dec_return(&rstc->triggered_count) < 0);
 266	}
 267
 268	return 0;
 269}
 270
 271static int reset_control_array_assert(struct reset_control_array *resets)
 272{
 273	int ret, i;
 274
 275	for (i = 0; i < resets->num_rstcs; i++) {
 276		ret = reset_control_assert(resets->rstc[i]);
 277		if (ret)
 278			goto err;
 279	}
 280
 281	return 0;
 282
 283err:
 284	while (i--)
 285		reset_control_deassert(resets->rstc[i]);
 286	return ret;
 287}
 288
 289static int reset_control_array_deassert(struct reset_control_array *resets)
 290{
 291	int ret, i;
 292
 293	for (i = 0; i < resets->num_rstcs; i++) {
 294		ret = reset_control_deassert(resets->rstc[i]);
 295		if (ret)
 296			goto err;
 297	}
 298
 299	return 0;
 300
 301err:
 302	while (i--)
 303		reset_control_assert(resets->rstc[i]);
 304	return ret;
 305}
 306
 307static int reset_control_array_acquire(struct reset_control_array *resets)
 308{
 309	unsigned int i;
 310	int err;
 311
 312	for (i = 0; i < resets->num_rstcs; i++) {
 313		err = reset_control_acquire(resets->rstc[i]);
 314		if (err < 0)
 315			goto release;
 316	}
 317
 318	return 0;
 319
 320release:
 321	while (i--)
 322		reset_control_release(resets->rstc[i]);
 323
 324	return err;
 325}
 326
 327static void reset_control_array_release(struct reset_control_array *resets)
 328{
 329	unsigned int i;
 330
 331	for (i = 0; i < resets->num_rstcs; i++)
 332		reset_control_release(resets->rstc[i]);
 333}
 334
 335static inline bool reset_control_is_array(struct reset_control *rstc)
 336{
 337	return rstc->array;
 338}
 339
 340/**
 341 * reset_control_reset - reset the controlled device
 342 * @rstc: reset controller
 343 *
 344 * On a shared reset line the actual reset pulse is only triggered once for the
 345 * lifetime of the reset_control instance: for all but the first caller this is
 346 * a no-op.
 347 * Consumers must not use reset_control_(de)assert on shared reset lines when
 348 * reset_control_reset has been used.
 349 *
 350 * If rstc is NULL it is an optional reset and the function will just
 351 * return 0.
 352 */
 353int reset_control_reset(struct reset_control *rstc)
 354{
 355	int ret;
 356
 357	if (!rstc)
 358		return 0;
 359
 360	if (WARN_ON(IS_ERR(rstc)))
 361		return -EINVAL;
 362
 363	if (reset_control_is_array(rstc))
 364		return reset_control_array_reset(rstc_to_array(rstc));
 365
 366	if (!rstc->rcdev->ops->reset)
 367		return -ENOTSUPP;
 368
 369	if (rstc->shared) {
 370		if (WARN_ON(atomic_read(&rstc->deassert_count) != 0))
 371			return -EINVAL;
 372
 373		if (atomic_inc_return(&rstc->triggered_count) != 1)
 374			return 0;
 375	} else {
 376		if (!rstc->acquired)
 377			return -EPERM;
 378	}
 379
 380	ret = rstc->rcdev->ops->reset(rstc->rcdev, rstc->id);
 381	if (rstc->shared && ret)
 382		atomic_dec(&rstc->triggered_count);
 383
 384	return ret;
 385}
 386EXPORT_SYMBOL_GPL(reset_control_reset);
 387
 388/**
 389 * reset_control_bulk_reset - reset the controlled devices in order
 390 * @num_rstcs: number of entries in rstcs array
 391 * @rstcs: array of struct reset_control_bulk_data with reset controls set
 392 *
 393 * Issue a reset on all provided reset controls, in order.
 394 *
 395 * See also: reset_control_reset()
 396 */
 397int reset_control_bulk_reset(int num_rstcs,
 398			     struct reset_control_bulk_data *rstcs)
 399{
 400	int ret, i;
 401
 402	for (i = 0; i < num_rstcs; i++) {
 403		ret = reset_control_reset(rstcs[i].rstc);
 404		if (ret)
 405			return ret;
 406	}
 407
 408	return 0;
 409}
 410EXPORT_SYMBOL_GPL(reset_control_bulk_reset);
 411
 412/**
 413 * reset_control_rearm - allow shared reset line to be re-triggered"
 414 * @rstc: reset controller
 415 *
 416 * On a shared reset line the actual reset pulse is only triggered once for the
 417 * lifetime of the reset_control instance, except if this call is used.
 418 *
 419 * Calls to this function must be balanced with calls to reset_control_reset,
 420 * a warning is thrown in case triggered_count ever dips below 0.
 421 *
 422 * Consumers must not use reset_control_(de)assert on shared reset lines when
 423 * reset_control_reset or reset_control_rearm have been used.
 424 *
 425 * If rstc is NULL the function will just return 0.
 426 */
 427int reset_control_rearm(struct reset_control *rstc)
 428{
 429	if (!rstc)
 430		return 0;
 431
 432	if (WARN_ON(IS_ERR(rstc)))
 433		return -EINVAL;
 434
 435	if (reset_control_is_array(rstc))
 436		return reset_control_array_rearm(rstc_to_array(rstc));
 437
 438	if (rstc->shared) {
 439		if (WARN_ON(atomic_read(&rstc->deassert_count) != 0))
 440			return -EINVAL;
 441
 442		WARN_ON(atomic_dec_return(&rstc->triggered_count) < 0);
 443	} else {
 444		if (!rstc->acquired)
 445			return -EPERM;
 446	}
 447
 448	return 0;
 449}
 450EXPORT_SYMBOL_GPL(reset_control_rearm);
 451
 452/**
 453 * reset_control_assert - asserts the reset line
 454 * @rstc: reset controller
 455 *
 456 * Calling this on an exclusive reset controller guarantees that the reset
 457 * will be asserted. When called on a shared reset controller the line may
 458 * still be deasserted, as long as other users keep it so.
 459 *
 460 * For shared reset controls a driver cannot expect the hw's registers and
 461 * internal state to be reset, but must be prepared for this to happen.
 462 * Consumers must not use reset_control_reset on shared reset lines when
 463 * reset_control_(de)assert has been used.
 464 *
 465 * If rstc is NULL it is an optional reset and the function will just
 466 * return 0.
 467 */
 468int reset_control_assert(struct reset_control *rstc)
 469{
 470	if (!rstc)
 471		return 0;
 472
 473	if (WARN_ON(IS_ERR(rstc)))
 474		return -EINVAL;
 475
 476	if (reset_control_is_array(rstc))
 477		return reset_control_array_assert(rstc_to_array(rstc));
 478
 479	if (rstc->shared) {
 480		if (WARN_ON(atomic_read(&rstc->triggered_count) != 0))
 481			return -EINVAL;
 482
 483		if (WARN_ON(atomic_read(&rstc->deassert_count) == 0))
 484			return -EINVAL;
 485
 486		if (atomic_dec_return(&rstc->deassert_count) != 0)
 487			return 0;
 488
 489		/*
 490		 * Shared reset controls allow the reset line to be in any state
 491		 * after this call, so doing nothing is a valid option.
 492		 */
 493		if (!rstc->rcdev->ops->assert)
 494			return 0;
 495	} else {
 496		/*
 497		 * If the reset controller does not implement .assert(), there
 498		 * is no way to guarantee that the reset line is asserted after
 499		 * this call.
 500		 */
 501		if (!rstc->rcdev->ops->assert)
 502			return -ENOTSUPP;
 503
 504		if (!rstc->acquired) {
 505			WARN(1, "reset %s (ID: %u) is not acquired\n",
 506			     rcdev_name(rstc->rcdev), rstc->id);
 507			return -EPERM;
 508		}
 509	}
 510
 511	return rstc->rcdev->ops->assert(rstc->rcdev, rstc->id);
 512}
 513EXPORT_SYMBOL_GPL(reset_control_assert);
 514
 515/**
 516 * reset_control_bulk_assert - asserts the reset lines in order
 517 * @num_rstcs: number of entries in rstcs array
 518 * @rstcs: array of struct reset_control_bulk_data with reset controls set
 519 *
 520 * Assert the reset lines for all provided reset controls, in order.
 521 * If an assertion fails, already asserted resets are deasserted again.
 522 *
 523 * See also: reset_control_assert()
 524 */
 525int reset_control_bulk_assert(int num_rstcs,
 526			      struct reset_control_bulk_data *rstcs)
 527{
 528	int ret, i;
 529
 530	for (i = 0; i < num_rstcs; i++) {
 531		ret = reset_control_assert(rstcs[i].rstc);
 532		if (ret)
 533			goto err;
 534	}
 535
 536	return 0;
 537
 538err:
 539	while (i--)
 540		reset_control_deassert(rstcs[i].rstc);
 541	return ret;
 542}
 543EXPORT_SYMBOL_GPL(reset_control_bulk_assert);
 544
 545/**
 546 * reset_control_deassert - deasserts the reset line
 547 * @rstc: reset controller
 548 *
 549 * After calling this function, the reset is guaranteed to be deasserted.
 550 * Consumers must not use reset_control_reset on shared reset lines when
 551 * reset_control_(de)assert has been used.
 552 *
 553 * If rstc is NULL it is an optional reset and the function will just
 554 * return 0.
 555 */
 556int reset_control_deassert(struct reset_control *rstc)
 557{
 558	if (!rstc)
 559		return 0;
 560
 561	if (WARN_ON(IS_ERR(rstc)))
 562		return -EINVAL;
 563
 564	if (reset_control_is_array(rstc))
 565		return reset_control_array_deassert(rstc_to_array(rstc));
 566
 567	if (rstc->shared) {
 568		if (WARN_ON(atomic_read(&rstc->triggered_count) != 0))
 569			return -EINVAL;
 570
 571		if (atomic_inc_return(&rstc->deassert_count) != 1)
 572			return 0;
 573	} else {
 574		if (!rstc->acquired) {
 575			WARN(1, "reset %s (ID: %u) is not acquired\n",
 576			     rcdev_name(rstc->rcdev), rstc->id);
 577			return -EPERM;
 578		}
 579	}
 580
 581	/*
 582	 * If the reset controller does not implement .deassert(), we assume
 583	 * that it handles self-deasserting reset lines via .reset(). In that
 584	 * case, the reset lines are deasserted by default. If that is not the
 585	 * case, the reset controller driver should implement .deassert() and
 586	 * return -ENOTSUPP.
 587	 */
 588	if (!rstc->rcdev->ops->deassert)
 589		return 0;
 590
 591	return rstc->rcdev->ops->deassert(rstc->rcdev, rstc->id);
 592}
 593EXPORT_SYMBOL_GPL(reset_control_deassert);
 594
 595/**
 596 * reset_control_bulk_deassert - deasserts the reset lines in reverse order
 597 * @num_rstcs: number of entries in rstcs array
 598 * @rstcs: array of struct reset_control_bulk_data with reset controls set
 599 *
 600 * Deassert the reset lines for all provided reset controls, in reverse order.
 601 * If a deassertion fails, already deasserted resets are asserted again.
 602 *
 603 * See also: reset_control_deassert()
 604 */
 605int reset_control_bulk_deassert(int num_rstcs,
 606				struct reset_control_bulk_data *rstcs)
 607{
 608	int ret, i;
 609
 610	for (i = num_rstcs - 1; i >= 0; i--) {
 611		ret = reset_control_deassert(rstcs[i].rstc);
 612		if (ret)
 613			goto err;
 614	}
 615
 616	return 0;
 617
 618err:
 619	while (i < num_rstcs)
 620		reset_control_assert(rstcs[i++].rstc);
 621	return ret;
 622}
 623EXPORT_SYMBOL_GPL(reset_control_bulk_deassert);
 624
 625/**
 626 * reset_control_status - returns a negative errno if not supported, a
 627 * positive value if the reset line is asserted, or zero if the reset
 628 * line is not asserted or if the desc is NULL (optional reset).
 629 * @rstc: reset controller
 630 */
 631int reset_control_status(struct reset_control *rstc)
 632{
 633	if (!rstc)
 634		return 0;
 635
 636	if (WARN_ON(IS_ERR(rstc)) || reset_control_is_array(rstc))
 637		return -EINVAL;
 638
 639	if (rstc->rcdev->ops->status)
 640		return rstc->rcdev->ops->status(rstc->rcdev, rstc->id);
 641
 642	return -ENOTSUPP;
 643}
 644EXPORT_SYMBOL_GPL(reset_control_status);
 645
 646/**
 647 * reset_control_acquire() - acquires a reset control for exclusive use
 648 * @rstc: reset control
 649 *
 650 * This is used to explicitly acquire a reset control for exclusive use. Note
 651 * that exclusive resets are requested as acquired by default. In order for a
 652 * second consumer to be able to control the reset, the first consumer has to
 653 * release it first. Typically the easiest way to achieve this is to call the
 654 * reset_control_get_exclusive_released() to obtain an instance of the reset
 655 * control. Such reset controls are not acquired by default.
 656 *
 657 * Consumers implementing shared access to an exclusive reset need to follow
 658 * a specific protocol in order to work together. Before consumers can change
 659 * a reset they must acquire exclusive access using reset_control_acquire().
 660 * After they are done operating the reset, they must release exclusive access
 661 * with a call to reset_control_release(). Consumers are not granted exclusive
 662 * access to the reset as long as another consumer hasn't released a reset.
 663 *
 664 * See also: reset_control_release()
 665 */
 666int reset_control_acquire(struct reset_control *rstc)
 667{
 668	struct reset_control *rc;
 669
 670	if (!rstc)
 671		return 0;
 672
 673	if (WARN_ON(IS_ERR(rstc)))
 674		return -EINVAL;
 675
 676	if (reset_control_is_array(rstc))
 677		return reset_control_array_acquire(rstc_to_array(rstc));
 678
 679	mutex_lock(&reset_list_mutex);
 680
 681	if (rstc->acquired) {
 682		mutex_unlock(&reset_list_mutex);
 683		return 0;
 684	}
 685
 686	list_for_each_entry(rc, &rstc->rcdev->reset_control_head, list) {
 687		if (rstc != rc && rstc->id == rc->id) {
 688			if (rc->acquired) {
 689				mutex_unlock(&reset_list_mutex);
 690				return -EBUSY;
 691			}
 692		}
 693	}
 694
 695	rstc->acquired = true;
 696
 697	mutex_unlock(&reset_list_mutex);
 698	return 0;
 699}
 700EXPORT_SYMBOL_GPL(reset_control_acquire);
 701
 702/**
 703 * reset_control_bulk_acquire - acquires reset controls for exclusive use
 704 * @num_rstcs: number of entries in rstcs array
 705 * @rstcs: array of struct reset_control_bulk_data with reset controls set
 706 *
 707 * This is used to explicitly acquire reset controls requested with
 708 * reset_control_bulk_get_exclusive_release() for temporary exclusive use.
 709 *
 710 * See also: reset_control_acquire(), reset_control_bulk_release()
 711 */
 712int reset_control_bulk_acquire(int num_rstcs,
 713			       struct reset_control_bulk_data *rstcs)
 714{
 715	int ret, i;
 716
 717	for (i = 0; i < num_rstcs; i++) {
 718		ret = reset_control_acquire(rstcs[i].rstc);
 719		if (ret)
 720			goto err;
 721	}
 722
 723	return 0;
 724
 725err:
 726	while (i--)
 727		reset_control_release(rstcs[i].rstc);
 728	return ret;
 729}
 730EXPORT_SYMBOL_GPL(reset_control_bulk_acquire);
 731
 732/**
 733 * reset_control_release() - releases exclusive access to a reset control
 734 * @rstc: reset control
 735 *
 736 * Releases exclusive access right to a reset control previously obtained by a
 737 * call to reset_control_acquire(). Until a consumer calls this function, no
 738 * other consumers will be granted exclusive access.
 739 *
 740 * See also: reset_control_acquire()
 741 */
 742void reset_control_release(struct reset_control *rstc)
 743{
 744	if (!rstc || WARN_ON(IS_ERR(rstc)))
 745		return;
 746
 747	if (reset_control_is_array(rstc))
 748		reset_control_array_release(rstc_to_array(rstc));
 749	else
 750		rstc->acquired = false;
 751}
 752EXPORT_SYMBOL_GPL(reset_control_release);
 753
 754/**
 755 * reset_control_bulk_release() - releases exclusive access to reset controls
 756 * @num_rstcs: number of entries in rstcs array
 757 * @rstcs: array of struct reset_control_bulk_data with reset controls set
 758 *
 759 * Releases exclusive access right to reset controls previously obtained by a
 760 * call to reset_control_bulk_acquire().
 761 *
 762 * See also: reset_control_release(), reset_control_bulk_acquire()
 763 */
 764void reset_control_bulk_release(int num_rstcs,
 765				struct reset_control_bulk_data *rstcs)
 766{
 767	int i;
 768
 769	for (i = 0; i < num_rstcs; i++)
 770		reset_control_release(rstcs[i].rstc);
 771}
 772EXPORT_SYMBOL_GPL(reset_control_bulk_release);
 773
 774static struct reset_control *
 775__reset_control_get_internal(struct reset_controller_dev *rcdev,
 776			     unsigned int index, enum reset_control_flags flags)
 777{
 778	bool shared = flags & RESET_CONTROL_FLAGS_BIT_SHARED;
 779	bool acquired = flags & RESET_CONTROL_FLAGS_BIT_ACQUIRED;
 780	struct reset_control *rstc;
 781
 782	lockdep_assert_held(&reset_list_mutex);
 783
 784	/* Expect callers to filter out OPTIONAL and DEASSERTED bits */
 785	if (WARN_ON(flags & ~(RESET_CONTROL_FLAGS_BIT_SHARED |
 786			      RESET_CONTROL_FLAGS_BIT_ACQUIRED)))
 787		return ERR_PTR(-EINVAL);
 788
 789	list_for_each_entry(rstc, &rcdev->reset_control_head, list) {
 790		if (rstc->id == index) {
 791			/*
 792			 * Allow creating a secondary exclusive reset_control
 793			 * that is initially not acquired for an already
 794			 * controlled reset line.
 795			 */
 796			if (!rstc->shared && !shared && !acquired)
 797				break;
 798
 799			if (WARN_ON(!rstc->shared || !shared))
 800				return ERR_PTR(-EBUSY);
 801
 802			kref_get(&rstc->refcnt);
 803			return rstc;
 804		}
 805	}
 806
 807	rstc = kzalloc(sizeof(*rstc), GFP_KERNEL);
 808	if (!rstc)
 809		return ERR_PTR(-ENOMEM);
 810
 811	if (!try_module_get(rcdev->owner)) {
 812		kfree(rstc);
 813		return ERR_PTR(-ENODEV);
 814	}
 815
 816	rstc->rcdev = rcdev;
 817	list_add(&rstc->list, &rcdev->reset_control_head);
 818	rstc->id = index;
 819	kref_init(&rstc->refcnt);
 820	rstc->acquired = acquired;
 821	rstc->shared = shared;
 822	get_device(rcdev->dev);
 823
 824	return rstc;
 825}
 826
 827static void __reset_control_release(struct kref *kref)
 828{
 829	struct reset_control *rstc = container_of(kref, struct reset_control,
 830						  refcnt);
 831
 832	lockdep_assert_held(&reset_list_mutex);
 833
 834	module_put(rstc->rcdev->owner);
 835
 836	list_del(&rstc->list);
 837	put_device(rstc->rcdev->dev);
 838	kfree(rstc);
 839}
 840
 841static void __reset_control_put_internal(struct reset_control *rstc)
 842{
 843	lockdep_assert_held(&reset_list_mutex);
 844
 845	if (IS_ERR_OR_NULL(rstc))
 846		return;
 847
 848	kref_put(&rstc->refcnt, __reset_control_release);
 849}
 850
 851static int __reset_add_reset_gpio_lookup(int id, struct device_node *np,
 852					 unsigned int gpio,
 853					 unsigned int of_flags)
 854{
 855	const struct fwnode_handle *fwnode = of_fwnode_handle(np);
 856	unsigned int lookup_flags;
 857	const char *label_tmp;
 858
 859	/*
 860	 * Later we map GPIO flags between OF and Linux, however not all
 861	 * constants from include/dt-bindings/gpio/gpio.h and
 862	 * include/linux/gpio/machine.h match each other.
 863	 */
 864	if (of_flags > GPIO_ACTIVE_LOW) {
 865		pr_err("reset-gpio code does not support GPIO flags %u for GPIO %u\n",
 866		       of_flags, gpio);
 867		return -EINVAL;
 868	}
 869
 870	struct gpio_device *gdev __free(gpio_device_put) = gpio_device_find_by_fwnode(fwnode);
 871	if (!gdev)
 872		return -EPROBE_DEFER;
 873
 874	label_tmp = gpio_device_get_label(gdev);
 875	if (!label_tmp)
 876		return -EINVAL;
 877
 878	char *label __free(kfree) = kstrdup(label_tmp, GFP_KERNEL);
 879	if (!label)
 880		return -ENOMEM;
 881
 882	/* Size: one lookup entry plus sentinel */
 883	struct gpiod_lookup_table *lookup __free(kfree) = kzalloc(struct_size(lookup, table, 2),
 884								  GFP_KERNEL);
 885	if (!lookup)
 886		return -ENOMEM;
 887
 888	lookup->dev_id = kasprintf(GFP_KERNEL, "reset-gpio.%d", id);
 889	if (!lookup->dev_id)
 890		return -ENOMEM;
 891
 892	lookup_flags = GPIO_PERSISTENT;
 893	lookup_flags |= of_flags & GPIO_ACTIVE_LOW;
 894	lookup->table[0] = GPIO_LOOKUP(no_free_ptr(label), gpio, "reset",
 895				       lookup_flags);
 896
 897	/* Not freed on success, because it is persisent subsystem data. */
 898	gpiod_add_lookup_table(no_free_ptr(lookup));
 899
 900	return 0;
 901}
 902
 903/*
 904 * @args:	phandle to the GPIO provider with all the args like GPIO number
 905 */
 906static int __reset_add_reset_gpio_device(const struct of_phandle_args *args)
 907{
 908	struct reset_gpio_lookup *rgpio_dev;
 909	struct platform_device *pdev;
 910	int id, ret;
 911
 912	/*
 913	 * Currently only #gpio-cells=2 is supported with the meaning of:
 914	 * args[0]: GPIO number
 915	 * args[1]: GPIO flags
 916	 * TODO: Handle other cases.
 917	 */
 918	if (args->args_count != 2)
 919		return -ENOENT;
 920
 921	/*
 922	 * Registering reset-gpio device might cause immediate
 923	 * bind, resulting in its probe() registering new reset controller thus
 924	 * taking reset_list_mutex lock via reset_controller_register().
 925	 */
 926	lockdep_assert_not_held(&reset_list_mutex);
 927
 928	guard(mutex)(&reset_gpio_lookup_mutex);
 929
 930	list_for_each_entry(rgpio_dev, &reset_gpio_lookup_list, list) {
 931		if (args->np == rgpio_dev->of_args.np) {
 932			if (of_phandle_args_equal(args, &rgpio_dev->of_args))
 933				return 0; /* Already on the list, done */
 934		}
 935	}
 936
 937	id = ida_alloc(&reset_gpio_ida, GFP_KERNEL);
 938	if (id < 0)
 939		return id;
 940
 941	/* Not freed on success, because it is persisent subsystem data. */
 942	rgpio_dev = kzalloc(sizeof(*rgpio_dev), GFP_KERNEL);
 943	if (!rgpio_dev) {
 944		ret = -ENOMEM;
 945		goto err_ida_free;
 946	}
 947
 948	ret = __reset_add_reset_gpio_lookup(id, args->np, args->args[0],
 949					    args->args[1]);
 950	if (ret < 0)
 951		goto err_kfree;
 952
 953	rgpio_dev->of_args = *args;
 954	/*
 955	 * We keep the device_node reference, but of_args.np is put at the end
 956	 * of __of_reset_control_get(), so get it one more time.
 957	 * Hold reference as long as rgpio_dev memory is valid.
 958	 */
 959	of_node_get(rgpio_dev->of_args.np);
 960	pdev = platform_device_register_data(NULL, "reset-gpio", id,
 961					     &rgpio_dev->of_args,
 962					     sizeof(rgpio_dev->of_args));
 963	ret = PTR_ERR_OR_ZERO(pdev);
 964	if (ret)
 965		goto err_put;
 966
 967	list_add(&rgpio_dev->list, &reset_gpio_lookup_list);
 968
 969	return 0;
 970
 971err_put:
 972	of_node_put(rgpio_dev->of_args.np);
 973err_kfree:
 974	kfree(rgpio_dev);
 975err_ida_free:
 976	ida_free(&reset_gpio_ida, id);
 977
 978	return ret;
 979}
 980
 981static struct reset_controller_dev *__reset_find_rcdev(const struct of_phandle_args *args,
 982						       bool gpio_fallback)
 983{
 984	struct reset_controller_dev *rcdev;
 985
 986	lockdep_assert_held(&reset_list_mutex);
 987
 988	list_for_each_entry(rcdev, &reset_controller_list, list) {
 989		if (gpio_fallback) {
 990			if (rcdev->of_args && of_phandle_args_equal(args,
 991								    rcdev->of_args))
 992				return rcdev;
 993		} else {
 994			if (args->np == rcdev->of_node)
 995				return rcdev;
 996		}
 997	}
 998
 999	return NULL;
1000}
1001
1002struct reset_control *
1003__of_reset_control_get(struct device_node *node, const char *id, int index,
1004		       enum reset_control_flags flags)
1005{
1006	bool optional = flags & RESET_CONTROL_FLAGS_BIT_OPTIONAL;
1007	bool gpio_fallback = false;
1008	struct reset_control *rstc;
1009	struct reset_controller_dev *rcdev;
1010	struct of_phandle_args args;
1011	int rstc_id;
1012	int ret;
1013
1014	if (!node)
1015		return ERR_PTR(-EINVAL);
1016
1017	if (id) {
1018		index = of_property_match_string(node,
1019						 "reset-names", id);
1020		if (index == -EILSEQ)
1021			return ERR_PTR(index);
1022		if (index < 0)
1023			return optional ? NULL : ERR_PTR(-ENOENT);
1024	}
1025
1026	ret = of_parse_phandle_with_args(node, "resets", "#reset-cells",
1027					 index, &args);
1028	if (ret == -EINVAL)
1029		return ERR_PTR(ret);
1030	if (ret) {
1031		if (!IS_ENABLED(CONFIG_RESET_GPIO))
1032			return optional ? NULL : ERR_PTR(ret);
1033
1034		/*
1035		 * There can be only one reset-gpio for regular devices, so
1036		 * don't bother with the "reset-gpios" phandle index.
1037		 */
1038		ret = of_parse_phandle_with_args(node, "reset-gpios", "#gpio-cells",
1039						 0, &args);
1040		if (ret)
1041			return optional ? NULL : ERR_PTR(ret);
1042
1043		gpio_fallback = true;
1044
1045		ret = __reset_add_reset_gpio_device(&args);
1046		if (ret) {
1047			rstc = ERR_PTR(ret);
1048			goto out_put;
1049		}
1050	}
1051
1052	mutex_lock(&reset_list_mutex);
1053	rcdev = __reset_find_rcdev(&args, gpio_fallback);
1054	if (!rcdev) {
1055		rstc = ERR_PTR(-EPROBE_DEFER);
1056		goto out_unlock;
1057	}
1058
1059	if (WARN_ON(args.args_count != rcdev->of_reset_n_cells)) {
1060		rstc = ERR_PTR(-EINVAL);
1061		goto out_unlock;
1062	}
1063
1064	rstc_id = rcdev->of_xlate(rcdev, &args);
1065	if (rstc_id < 0) {
1066		rstc = ERR_PTR(rstc_id);
1067		goto out_unlock;
1068	}
1069
1070	flags &= ~RESET_CONTROL_FLAGS_BIT_OPTIONAL;
1071
1072	/* reset_list_mutex also protects the rcdev's reset_control list */
1073	rstc = __reset_control_get_internal(rcdev, rstc_id, flags);
1074
1075out_unlock:
1076	mutex_unlock(&reset_list_mutex);
1077out_put:
1078	of_node_put(args.np);
1079
1080	return rstc;
1081}
1082EXPORT_SYMBOL_GPL(__of_reset_control_get);
1083
1084static struct reset_controller_dev *
1085__reset_controller_by_name(const char *name)
1086{
1087	struct reset_controller_dev *rcdev;
1088
1089	lockdep_assert_held(&reset_list_mutex);
1090
1091	list_for_each_entry(rcdev, &reset_controller_list, list) {
1092		if (!rcdev->dev)
1093			continue;
1094
1095		if (!strcmp(name, dev_name(rcdev->dev)))
1096			return rcdev;
1097	}
1098
1099	return NULL;
1100}
1101
1102static struct reset_control *
1103__reset_control_get_from_lookup(struct device *dev, const char *con_id,
1104				enum reset_control_flags flags)
1105{
1106	bool optional = flags & RESET_CONTROL_FLAGS_BIT_OPTIONAL;
1107	const struct reset_control_lookup *lookup;
1108	struct reset_controller_dev *rcdev;
1109	const char *dev_id = dev_name(dev);
1110	struct reset_control *rstc = NULL;
1111
1112	mutex_lock(&reset_lookup_mutex);
1113
1114	list_for_each_entry(lookup, &reset_lookup_list, list) {
1115		if (strcmp(lookup->dev_id, dev_id))
1116			continue;
1117
1118		if ((!con_id && !lookup->con_id) ||
1119		    ((con_id && lookup->con_id) &&
1120		     !strcmp(con_id, lookup->con_id))) {
1121			mutex_lock(&reset_list_mutex);
1122			rcdev = __reset_controller_by_name(lookup->provider);
1123			if (!rcdev) {
1124				mutex_unlock(&reset_list_mutex);
1125				mutex_unlock(&reset_lookup_mutex);
1126				/* Reset provider may not be ready yet. */
1127				return ERR_PTR(-EPROBE_DEFER);
1128			}
1129
1130			flags &= ~RESET_CONTROL_FLAGS_BIT_OPTIONAL;
1131
1132			rstc = __reset_control_get_internal(rcdev,
1133							    lookup->index,
1134							    flags);
1135			mutex_unlock(&reset_list_mutex);
1136			break;
1137		}
1138	}
1139
1140	mutex_unlock(&reset_lookup_mutex);
1141
1142	if (!rstc)
1143		return optional ? NULL : ERR_PTR(-ENOENT);
1144
1145	return rstc;
1146}
1147
1148struct reset_control *__reset_control_get(struct device *dev, const char *id,
1149					  int index, enum reset_control_flags flags)
 
1150{
1151	bool shared = flags & RESET_CONTROL_FLAGS_BIT_SHARED;
1152	bool acquired = flags & RESET_CONTROL_FLAGS_BIT_ACQUIRED;
1153
1154	if (WARN_ON(shared && acquired))
1155		return ERR_PTR(-EINVAL);
1156
1157	if (dev->of_node)
1158		return __of_reset_control_get(dev->of_node, id, index, flags);
 
1159
1160	return __reset_control_get_from_lookup(dev, id, flags);
 
1161}
1162EXPORT_SYMBOL_GPL(__reset_control_get);
1163
1164int __reset_control_bulk_get(struct device *dev, int num_rstcs,
1165			     struct reset_control_bulk_data *rstcs,
1166			     enum reset_control_flags flags)
1167{
1168	int ret, i;
1169
1170	for (i = 0; i < num_rstcs; i++) {
1171		rstcs[i].rstc = __reset_control_get(dev, rstcs[i].id, 0, flags);
1172		if (IS_ERR(rstcs[i].rstc)) {
1173			ret = PTR_ERR(rstcs[i].rstc);
1174			goto err;
1175		}
1176	}
1177
1178	return 0;
1179
1180err:
1181	mutex_lock(&reset_list_mutex);
1182	while (i--)
1183		__reset_control_put_internal(rstcs[i].rstc);
1184	mutex_unlock(&reset_list_mutex);
1185	return ret;
1186}
1187EXPORT_SYMBOL_GPL(__reset_control_bulk_get);
1188
1189static void reset_control_array_put(struct reset_control_array *resets)
1190{
1191	int i;
1192
1193	mutex_lock(&reset_list_mutex);
1194	for (i = 0; i < resets->num_rstcs; i++)
1195		__reset_control_put_internal(resets->rstc[i]);
1196	mutex_unlock(&reset_list_mutex);
1197	kfree(resets);
1198}
1199
1200/**
1201 * reset_control_put - free the reset controller
1202 * @rstc: reset controller
1203 */
1204void reset_control_put(struct reset_control *rstc)
1205{
1206	if (IS_ERR_OR_NULL(rstc))
1207		return;
1208
1209	if (reset_control_is_array(rstc)) {
1210		reset_control_array_put(rstc_to_array(rstc));
1211		return;
1212	}
1213
1214	mutex_lock(&reset_list_mutex);
1215	__reset_control_put_internal(rstc);
1216	mutex_unlock(&reset_list_mutex);
1217}
1218EXPORT_SYMBOL_GPL(reset_control_put);
1219
1220/**
1221 * reset_control_bulk_put - free the reset controllers
1222 * @num_rstcs: number of entries in rstcs array
1223 * @rstcs: array of struct reset_control_bulk_data with reset controls set
1224 */
1225void reset_control_bulk_put(int num_rstcs, struct reset_control_bulk_data *rstcs)
1226{
1227	mutex_lock(&reset_list_mutex);
1228	while (num_rstcs--)
1229		__reset_control_put_internal(rstcs[num_rstcs].rstc);
1230	mutex_unlock(&reset_list_mutex);
1231}
1232EXPORT_SYMBOL_GPL(reset_control_bulk_put);
1233
1234static void devm_reset_control_release(struct device *dev, void *res)
1235{
1236	reset_control_put(*(struct reset_control **)res);
1237}
1238
1239static void devm_reset_control_release_deasserted(struct device *dev, void *res)
1240{
1241	struct reset_control *rstc = *(struct reset_control **)res;
1242
1243	reset_control_assert(rstc);
1244	reset_control_put(rstc);
1245}
1246
1247struct reset_control *
1248__devm_reset_control_get(struct device *dev, const char *id, int index,
1249			 enum reset_control_flags flags)
1250{
1251	struct reset_control **ptr, *rstc;
1252	bool deasserted = flags & RESET_CONTROL_FLAGS_BIT_DEASSERTED;
1253
1254	ptr = devres_alloc(deasserted ? devm_reset_control_release_deasserted :
1255			   devm_reset_control_release, sizeof(*ptr),
1256			   GFP_KERNEL);
1257	if (!ptr)
1258		return ERR_PTR(-ENOMEM);
1259
1260	flags &= ~RESET_CONTROL_FLAGS_BIT_DEASSERTED;
1261
1262	rstc = __reset_control_get(dev, id, index, flags);
1263	if (IS_ERR_OR_NULL(rstc)) {
1264		devres_free(ptr);
1265		return rstc;
1266	}
1267
1268	if (deasserted) {
1269		int ret;
1270
1271		ret = reset_control_deassert(rstc);
1272		if (ret) {
1273			reset_control_put(rstc);
1274			devres_free(ptr);
1275			return ERR_PTR(ret);
1276		}
1277	}
1278
1279	*ptr = rstc;
1280	devres_add(dev, ptr);
1281
1282	return rstc;
1283}
1284EXPORT_SYMBOL_GPL(__devm_reset_control_get);
1285
1286struct reset_control_bulk_devres {
1287	int num_rstcs;
1288	struct reset_control_bulk_data *rstcs;
1289};
1290
1291static void devm_reset_control_bulk_release(struct device *dev, void *res)
1292{
1293	struct reset_control_bulk_devres *devres = res;
1294
1295	reset_control_bulk_put(devres->num_rstcs, devres->rstcs);
1296}
1297
1298static void devm_reset_control_bulk_release_deasserted(struct device *dev, void *res)
1299{
1300	struct reset_control_bulk_devres *devres = res;
1301
1302	reset_control_bulk_assert(devres->num_rstcs, devres->rstcs);
1303	reset_control_bulk_put(devres->num_rstcs, devres->rstcs);
1304}
1305
1306int __devm_reset_control_bulk_get(struct device *dev, int num_rstcs,
1307				  struct reset_control_bulk_data *rstcs,
1308				  enum reset_control_flags flags)
1309{
1310	struct reset_control_bulk_devres *ptr;
1311	bool deasserted = flags & RESET_CONTROL_FLAGS_BIT_DEASSERTED;
1312	int ret;
1313
1314	ptr = devres_alloc(deasserted ? devm_reset_control_bulk_release_deasserted :
1315			   devm_reset_control_bulk_release, sizeof(*ptr),
1316			   GFP_KERNEL);
1317	if (!ptr)
1318		return -ENOMEM;
1319
1320	flags &= ~RESET_CONTROL_FLAGS_BIT_DEASSERTED;
1321
1322	ret = __reset_control_bulk_get(dev, num_rstcs, rstcs, flags);
1323	if (ret < 0) {
1324		devres_free(ptr);
1325		return ret;
1326	}
1327
1328	if (deasserted) {
1329		ret = reset_control_bulk_deassert(num_rstcs, rstcs);
1330		if (ret) {
1331			reset_control_bulk_put(num_rstcs, rstcs);
1332			devres_free(ptr);
1333			return ret;
1334		}
1335	}
1336
1337	ptr->num_rstcs = num_rstcs;
1338	ptr->rstcs = rstcs;
1339	devres_add(dev, ptr);
1340
1341	return 0;
1342}
1343EXPORT_SYMBOL_GPL(__devm_reset_control_bulk_get);
1344
1345/**
1346 * __device_reset - find reset controller associated with the device
1347 *                  and perform reset
1348 * @dev: device to be reset by the controller
1349 * @optional: whether it is optional to reset the device
1350 *
1351 * Convenience wrapper for __reset_control_get() and reset_control_reset().
1352 * This is useful for the common case of devices with single, dedicated reset
1353 * lines. _RST firmware method will be called for devices with ACPI.
1354 */
1355int __device_reset(struct device *dev, bool optional)
1356{
1357	enum reset_control_flags flags;
1358	struct reset_control *rstc;
1359	int ret;
1360
1361#ifdef CONFIG_ACPI
1362	acpi_handle handle = ACPI_HANDLE(dev);
1363
1364	if (handle) {
1365		if (!acpi_has_method(handle, "_RST"))
1366			return optional ? 0 : -ENOENT;
1367		if (ACPI_FAILURE(acpi_evaluate_object(handle, "_RST", NULL,
1368						      NULL)))
1369			return -EIO;
1370	}
1371#endif
1372
1373	flags = optional ? RESET_CONTROL_OPTIONAL_EXCLUSIVE : RESET_CONTROL_EXCLUSIVE;
1374	rstc = __reset_control_get(dev, NULL, 0, flags);
1375	if (IS_ERR(rstc))
1376		return PTR_ERR(rstc);
1377
1378	ret = reset_control_reset(rstc);
1379
1380	reset_control_put(rstc);
1381
1382	return ret;
1383}
1384EXPORT_SYMBOL_GPL(__device_reset);
1385
1386/*
1387 * APIs to manage an array of reset controls.
1388 */
1389
1390/**
1391 * of_reset_control_get_count - Count number of resets available with a device
1392 *
1393 * @node: device node that contains 'resets'.
1394 *
1395 * Returns positive reset count on success, or error number on failure and
1396 * on count being zero.
1397 */
1398static int of_reset_control_get_count(struct device_node *node)
1399{
1400	int count;
1401
1402	if (!node)
1403		return -EINVAL;
1404
1405	count = of_count_phandle_with_args(node, "resets", "#reset-cells");
1406	if (count == 0)
1407		count = -ENOENT;
1408
1409	return count;
1410}
1411
1412/**
1413 * of_reset_control_array_get - Get a list of reset controls using
1414 *				device node.
1415 *
1416 * @np: device node for the device that requests the reset controls array
1417 * @flags: whether reset controls are shared, optional, acquired
 
 
 
1418 *
1419 * Returns pointer to allocated reset_control on success or error on failure
1420 */
1421struct reset_control *
1422of_reset_control_array_get(struct device_node *np, enum reset_control_flags flags)
 
1423{
1424	bool optional = flags & RESET_CONTROL_FLAGS_BIT_OPTIONAL;
1425	struct reset_control_array *resets;
1426	struct reset_control *rstc;
1427	int num, i;
1428
1429	num = of_reset_control_get_count(np);
1430	if (num < 0)
1431		return optional ? NULL : ERR_PTR(num);
1432
1433	resets = kzalloc(struct_size(resets, rstc, num), GFP_KERNEL);
1434	if (!resets)
1435		return ERR_PTR(-ENOMEM);
1436	resets->num_rstcs = num;
1437
1438	for (i = 0; i < num; i++) {
1439		rstc = __of_reset_control_get(np, NULL, i, flags);
 
1440		if (IS_ERR(rstc))
1441			goto err_rst;
1442		resets->rstc[i] = rstc;
1443	}
 
1444	resets->base.array = true;
1445
1446	return &resets->base;
1447
1448err_rst:
1449	mutex_lock(&reset_list_mutex);
1450	while (--i >= 0)
1451		__reset_control_put_internal(resets->rstc[i]);
1452	mutex_unlock(&reset_list_mutex);
1453
1454	kfree(resets);
1455
1456	return rstc;
1457}
1458EXPORT_SYMBOL_GPL(of_reset_control_array_get);
1459
1460/**
1461 * devm_reset_control_array_get - Resource managed reset control array get
1462 *
1463 * @dev: device that requests the list of reset controls
1464 * @flags: whether reset controls are shared, optional, acquired
 
1465 *
1466 * The reset control array APIs are intended for a list of resets
1467 * that just have to be asserted or deasserted, without any
1468 * requirements on the order.
1469 *
1470 * Returns pointer to allocated reset_control on success or error on failure
1471 */
1472struct reset_control *
1473devm_reset_control_array_get(struct device *dev, enum reset_control_flags flags)
1474{
1475	struct reset_control **ptr, *rstc;
1476
1477	ptr = devres_alloc(devm_reset_control_release, sizeof(*ptr),
1478			   GFP_KERNEL);
1479	if (!ptr)
1480		return ERR_PTR(-ENOMEM);
1481
1482	rstc = of_reset_control_array_get(dev->of_node, flags);
1483	if (IS_ERR_OR_NULL(rstc)) {
1484		devres_free(ptr);
1485		return rstc;
1486	}
1487
1488	*ptr = rstc;
1489	devres_add(dev, ptr);
1490
1491	return rstc;
1492}
1493EXPORT_SYMBOL_GPL(devm_reset_control_array_get);
1494
1495static int reset_control_get_count_from_lookup(struct device *dev)
1496{
1497	const struct reset_control_lookup *lookup;
1498	const char *dev_id;
1499	int count = 0;
1500
1501	if (!dev)
1502		return -EINVAL;
1503
1504	dev_id = dev_name(dev);
1505	mutex_lock(&reset_lookup_mutex);
1506
1507	list_for_each_entry(lookup, &reset_lookup_list, list) {
1508		if (!strcmp(lookup->dev_id, dev_id))
1509			count++;
1510	}
1511
1512	mutex_unlock(&reset_lookup_mutex);
1513
1514	if (count == 0)
1515		count = -ENOENT;
1516
1517	return count;
1518}
1519
1520/**
1521 * reset_control_get_count - Count number of resets available with a device
1522 *
1523 * @dev: device for which to return the number of resets
1524 *
1525 * Returns positive reset count on success, or error number on failure and
1526 * on count being zero.
1527 */
1528int reset_control_get_count(struct device *dev)
1529{
1530	if (dev->of_node)
1531		return of_reset_control_get_count(dev->of_node);
1532
1533	return reset_control_get_count_from_lookup(dev);
1534}
1535EXPORT_SYMBOL_GPL(reset_control_get_count);