18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Reset Controller framework 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * Copyright 2013 Philipp Zabel, Pengutronix 68c2ecf20Sopenharmony_ci */ 78c2ecf20Sopenharmony_ci#include <linux/atomic.h> 88c2ecf20Sopenharmony_ci#include <linux/device.h> 98c2ecf20Sopenharmony_ci#include <linux/err.h> 108c2ecf20Sopenharmony_ci#include <linux/export.h> 118c2ecf20Sopenharmony_ci#include <linux/kernel.h> 128c2ecf20Sopenharmony_ci#include <linux/kref.h> 138c2ecf20Sopenharmony_ci#include <linux/module.h> 148c2ecf20Sopenharmony_ci#include <linux/of.h> 158c2ecf20Sopenharmony_ci#include <linux/reset.h> 168c2ecf20Sopenharmony_ci#include <linux/reset-controller.h> 178c2ecf20Sopenharmony_ci#include <linux/slab.h> 188c2ecf20Sopenharmony_ci 198c2ecf20Sopenharmony_cistatic DEFINE_MUTEX(reset_list_mutex); 208c2ecf20Sopenharmony_cistatic LIST_HEAD(reset_controller_list); 218c2ecf20Sopenharmony_ci 228c2ecf20Sopenharmony_cistatic DEFINE_MUTEX(reset_lookup_mutex); 238c2ecf20Sopenharmony_cistatic LIST_HEAD(reset_lookup_list); 248c2ecf20Sopenharmony_ci 258c2ecf20Sopenharmony_ci/** 268c2ecf20Sopenharmony_ci * struct reset_control - a reset control 278c2ecf20Sopenharmony_ci * @rcdev: a pointer to the reset controller device 288c2ecf20Sopenharmony_ci * this reset control belongs to 298c2ecf20Sopenharmony_ci * @list: list entry for the rcdev's reset controller list 308c2ecf20Sopenharmony_ci * @id: ID of the reset controller in the reset 318c2ecf20Sopenharmony_ci * controller device 328c2ecf20Sopenharmony_ci * @refcnt: Number of gets of this reset_control 338c2ecf20Sopenharmony_ci * @acquired: Only one reset_control may be acquired for a given rcdev and id. 348c2ecf20Sopenharmony_ci * @shared: Is this a shared (1), or an exclusive (0) reset_control? 358c2ecf20Sopenharmony_ci * @array: Is this an array of reset controls (1)? 368c2ecf20Sopenharmony_ci * @deassert_count: Number of times this reset line has been deasserted 378c2ecf20Sopenharmony_ci * @triggered_count: Number of times this reset line has been reset. Currently 388c2ecf20Sopenharmony_ci * only used for shared resets, which means that the value 398c2ecf20Sopenharmony_ci * will be either 0 or 1. 408c2ecf20Sopenharmony_ci */ 418c2ecf20Sopenharmony_cistruct reset_control { 428c2ecf20Sopenharmony_ci struct reset_controller_dev *rcdev; 438c2ecf20Sopenharmony_ci struct list_head list; 448c2ecf20Sopenharmony_ci unsigned int id; 458c2ecf20Sopenharmony_ci struct kref refcnt; 468c2ecf20Sopenharmony_ci bool acquired; 478c2ecf20Sopenharmony_ci bool shared; 488c2ecf20Sopenharmony_ci bool array; 498c2ecf20Sopenharmony_ci atomic_t deassert_count; 508c2ecf20Sopenharmony_ci atomic_t triggered_count; 518c2ecf20Sopenharmony_ci}; 528c2ecf20Sopenharmony_ci 538c2ecf20Sopenharmony_ci/** 548c2ecf20Sopenharmony_ci * struct reset_control_array - an array of reset controls 558c2ecf20Sopenharmony_ci * @base: reset control for compatibility with reset control API functions 568c2ecf20Sopenharmony_ci * @num_rstcs: number of reset controls 578c2ecf20Sopenharmony_ci * @rstc: array of reset controls 588c2ecf20Sopenharmony_ci */ 598c2ecf20Sopenharmony_cistruct reset_control_array { 608c2ecf20Sopenharmony_ci struct reset_control base; 618c2ecf20Sopenharmony_ci unsigned int num_rstcs; 628c2ecf20Sopenharmony_ci struct reset_control *rstc[]; 638c2ecf20Sopenharmony_ci}; 648c2ecf20Sopenharmony_ci 658c2ecf20Sopenharmony_cistatic const char *rcdev_name(struct reset_controller_dev *rcdev) 668c2ecf20Sopenharmony_ci{ 678c2ecf20Sopenharmony_ci if (rcdev->dev) 688c2ecf20Sopenharmony_ci return dev_name(rcdev->dev); 698c2ecf20Sopenharmony_ci 708c2ecf20Sopenharmony_ci if (rcdev->of_node) 718c2ecf20Sopenharmony_ci return rcdev->of_node->full_name; 728c2ecf20Sopenharmony_ci 738c2ecf20Sopenharmony_ci return NULL; 748c2ecf20Sopenharmony_ci} 758c2ecf20Sopenharmony_ci 768c2ecf20Sopenharmony_ci/** 778c2ecf20Sopenharmony_ci * of_reset_simple_xlate - translate reset_spec to the reset line number 788c2ecf20Sopenharmony_ci * @rcdev: a pointer to the reset controller device 798c2ecf20Sopenharmony_ci * @reset_spec: reset line specifier as found in the device tree 808c2ecf20Sopenharmony_ci * 818c2ecf20Sopenharmony_ci * This static translation function is used by default if of_xlate in 828c2ecf20Sopenharmony_ci * :c:type:`reset_controller_dev` is not set. It is useful for all reset 838c2ecf20Sopenharmony_ci * controllers with 1:1 mapping, where reset lines can be indexed by number 848c2ecf20Sopenharmony_ci * without gaps. 858c2ecf20Sopenharmony_ci */ 868c2ecf20Sopenharmony_cistatic int of_reset_simple_xlate(struct reset_controller_dev *rcdev, 878c2ecf20Sopenharmony_ci const struct of_phandle_args *reset_spec) 888c2ecf20Sopenharmony_ci{ 898c2ecf20Sopenharmony_ci if (reset_spec->args[0] >= rcdev->nr_resets) 908c2ecf20Sopenharmony_ci return -EINVAL; 918c2ecf20Sopenharmony_ci 928c2ecf20Sopenharmony_ci return reset_spec->args[0]; 938c2ecf20Sopenharmony_ci} 948c2ecf20Sopenharmony_ci 958c2ecf20Sopenharmony_ci/** 968c2ecf20Sopenharmony_ci * reset_controller_register - register a reset controller device 978c2ecf20Sopenharmony_ci * @rcdev: a pointer to the initialized reset controller device 988c2ecf20Sopenharmony_ci */ 998c2ecf20Sopenharmony_ciint reset_controller_register(struct reset_controller_dev *rcdev) 1008c2ecf20Sopenharmony_ci{ 1018c2ecf20Sopenharmony_ci if (!rcdev->of_xlate) { 1028c2ecf20Sopenharmony_ci rcdev->of_reset_n_cells = 1; 1038c2ecf20Sopenharmony_ci rcdev->of_xlate = of_reset_simple_xlate; 1048c2ecf20Sopenharmony_ci } 1058c2ecf20Sopenharmony_ci 1068c2ecf20Sopenharmony_ci INIT_LIST_HEAD(&rcdev->reset_control_head); 1078c2ecf20Sopenharmony_ci 1088c2ecf20Sopenharmony_ci mutex_lock(&reset_list_mutex); 1098c2ecf20Sopenharmony_ci list_add(&rcdev->list, &reset_controller_list); 1108c2ecf20Sopenharmony_ci mutex_unlock(&reset_list_mutex); 1118c2ecf20Sopenharmony_ci 1128c2ecf20Sopenharmony_ci return 0; 1138c2ecf20Sopenharmony_ci} 1148c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(reset_controller_register); 1158c2ecf20Sopenharmony_ci 1168c2ecf20Sopenharmony_ci/** 1178c2ecf20Sopenharmony_ci * reset_controller_unregister - unregister a reset controller device 1188c2ecf20Sopenharmony_ci * @rcdev: a pointer to the reset controller device 1198c2ecf20Sopenharmony_ci */ 1208c2ecf20Sopenharmony_civoid reset_controller_unregister(struct reset_controller_dev *rcdev) 1218c2ecf20Sopenharmony_ci{ 1228c2ecf20Sopenharmony_ci mutex_lock(&reset_list_mutex); 1238c2ecf20Sopenharmony_ci list_del(&rcdev->list); 1248c2ecf20Sopenharmony_ci mutex_unlock(&reset_list_mutex); 1258c2ecf20Sopenharmony_ci} 1268c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(reset_controller_unregister); 1278c2ecf20Sopenharmony_ci 1288c2ecf20Sopenharmony_cistatic void devm_reset_controller_release(struct device *dev, void *res) 1298c2ecf20Sopenharmony_ci{ 1308c2ecf20Sopenharmony_ci reset_controller_unregister(*(struct reset_controller_dev **)res); 1318c2ecf20Sopenharmony_ci} 1328c2ecf20Sopenharmony_ci 1338c2ecf20Sopenharmony_ci/** 1348c2ecf20Sopenharmony_ci * devm_reset_controller_register - resource managed reset_controller_register() 1358c2ecf20Sopenharmony_ci * @dev: device that is registering this reset controller 1368c2ecf20Sopenharmony_ci * @rcdev: a pointer to the initialized reset controller device 1378c2ecf20Sopenharmony_ci * 1388c2ecf20Sopenharmony_ci * Managed reset_controller_register(). For reset controllers registered by 1398c2ecf20Sopenharmony_ci * this function, reset_controller_unregister() is automatically called on 1408c2ecf20Sopenharmony_ci * driver detach. See reset_controller_register() for more information. 1418c2ecf20Sopenharmony_ci */ 1428c2ecf20Sopenharmony_ciint devm_reset_controller_register(struct device *dev, 1438c2ecf20Sopenharmony_ci struct reset_controller_dev *rcdev) 1448c2ecf20Sopenharmony_ci{ 1458c2ecf20Sopenharmony_ci struct reset_controller_dev **rcdevp; 1468c2ecf20Sopenharmony_ci int ret; 1478c2ecf20Sopenharmony_ci 1488c2ecf20Sopenharmony_ci rcdevp = devres_alloc(devm_reset_controller_release, sizeof(*rcdevp), 1498c2ecf20Sopenharmony_ci GFP_KERNEL); 1508c2ecf20Sopenharmony_ci if (!rcdevp) 1518c2ecf20Sopenharmony_ci return -ENOMEM; 1528c2ecf20Sopenharmony_ci 1538c2ecf20Sopenharmony_ci ret = reset_controller_register(rcdev); 1548c2ecf20Sopenharmony_ci if (ret) { 1558c2ecf20Sopenharmony_ci devres_free(rcdevp); 1568c2ecf20Sopenharmony_ci return ret; 1578c2ecf20Sopenharmony_ci } 1588c2ecf20Sopenharmony_ci 1598c2ecf20Sopenharmony_ci *rcdevp = rcdev; 1608c2ecf20Sopenharmony_ci devres_add(dev, rcdevp); 1618c2ecf20Sopenharmony_ci 1628c2ecf20Sopenharmony_ci return ret; 1638c2ecf20Sopenharmony_ci} 1648c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(devm_reset_controller_register); 1658c2ecf20Sopenharmony_ci 1668c2ecf20Sopenharmony_ci/** 1678c2ecf20Sopenharmony_ci * reset_controller_add_lookup - register a set of lookup entries 1688c2ecf20Sopenharmony_ci * @lookup: array of reset lookup entries 1698c2ecf20Sopenharmony_ci * @num_entries: number of entries in the lookup array 1708c2ecf20Sopenharmony_ci */ 1718c2ecf20Sopenharmony_civoid reset_controller_add_lookup(struct reset_control_lookup *lookup, 1728c2ecf20Sopenharmony_ci unsigned int num_entries) 1738c2ecf20Sopenharmony_ci{ 1748c2ecf20Sopenharmony_ci struct reset_control_lookup *entry; 1758c2ecf20Sopenharmony_ci unsigned int i; 1768c2ecf20Sopenharmony_ci 1778c2ecf20Sopenharmony_ci mutex_lock(&reset_lookup_mutex); 1788c2ecf20Sopenharmony_ci for (i = 0; i < num_entries; i++) { 1798c2ecf20Sopenharmony_ci entry = &lookup[i]; 1808c2ecf20Sopenharmony_ci 1818c2ecf20Sopenharmony_ci if (!entry->dev_id || !entry->provider) { 1828c2ecf20Sopenharmony_ci pr_warn("%s(): reset lookup entry badly specified, skipping\n", 1838c2ecf20Sopenharmony_ci __func__); 1848c2ecf20Sopenharmony_ci continue; 1858c2ecf20Sopenharmony_ci } 1868c2ecf20Sopenharmony_ci 1878c2ecf20Sopenharmony_ci list_add_tail(&entry->list, &reset_lookup_list); 1888c2ecf20Sopenharmony_ci } 1898c2ecf20Sopenharmony_ci mutex_unlock(&reset_lookup_mutex); 1908c2ecf20Sopenharmony_ci} 1918c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(reset_controller_add_lookup); 1928c2ecf20Sopenharmony_ci 1938c2ecf20Sopenharmony_cistatic inline struct reset_control_array * 1948c2ecf20Sopenharmony_cirstc_to_array(struct reset_control *rstc) { 1958c2ecf20Sopenharmony_ci return container_of(rstc, struct reset_control_array, base); 1968c2ecf20Sopenharmony_ci} 1978c2ecf20Sopenharmony_ci 1988c2ecf20Sopenharmony_cistatic int reset_control_array_reset(struct reset_control_array *resets) 1998c2ecf20Sopenharmony_ci{ 2008c2ecf20Sopenharmony_ci int ret, i; 2018c2ecf20Sopenharmony_ci 2028c2ecf20Sopenharmony_ci for (i = 0; i < resets->num_rstcs; i++) { 2038c2ecf20Sopenharmony_ci ret = reset_control_reset(resets->rstc[i]); 2048c2ecf20Sopenharmony_ci if (ret) 2058c2ecf20Sopenharmony_ci return ret; 2068c2ecf20Sopenharmony_ci } 2078c2ecf20Sopenharmony_ci 2088c2ecf20Sopenharmony_ci return 0; 2098c2ecf20Sopenharmony_ci} 2108c2ecf20Sopenharmony_ci 2118c2ecf20Sopenharmony_cistatic int reset_control_array_assert(struct reset_control_array *resets) 2128c2ecf20Sopenharmony_ci{ 2138c2ecf20Sopenharmony_ci int ret, i; 2148c2ecf20Sopenharmony_ci 2158c2ecf20Sopenharmony_ci for (i = 0; i < resets->num_rstcs; i++) { 2168c2ecf20Sopenharmony_ci ret = reset_control_assert(resets->rstc[i]); 2178c2ecf20Sopenharmony_ci if (ret) 2188c2ecf20Sopenharmony_ci goto err; 2198c2ecf20Sopenharmony_ci } 2208c2ecf20Sopenharmony_ci 2218c2ecf20Sopenharmony_ci return 0; 2228c2ecf20Sopenharmony_ci 2238c2ecf20Sopenharmony_cierr: 2248c2ecf20Sopenharmony_ci while (i--) 2258c2ecf20Sopenharmony_ci reset_control_deassert(resets->rstc[i]); 2268c2ecf20Sopenharmony_ci return ret; 2278c2ecf20Sopenharmony_ci} 2288c2ecf20Sopenharmony_ci 2298c2ecf20Sopenharmony_cistatic int reset_control_array_deassert(struct reset_control_array *resets) 2308c2ecf20Sopenharmony_ci{ 2318c2ecf20Sopenharmony_ci int ret, i; 2328c2ecf20Sopenharmony_ci 2338c2ecf20Sopenharmony_ci for (i = 0; i < resets->num_rstcs; i++) { 2348c2ecf20Sopenharmony_ci ret = reset_control_deassert(resets->rstc[i]); 2358c2ecf20Sopenharmony_ci if (ret) 2368c2ecf20Sopenharmony_ci goto err; 2378c2ecf20Sopenharmony_ci } 2388c2ecf20Sopenharmony_ci 2398c2ecf20Sopenharmony_ci return 0; 2408c2ecf20Sopenharmony_ci 2418c2ecf20Sopenharmony_cierr: 2428c2ecf20Sopenharmony_ci while (i--) 2438c2ecf20Sopenharmony_ci reset_control_assert(resets->rstc[i]); 2448c2ecf20Sopenharmony_ci return ret; 2458c2ecf20Sopenharmony_ci} 2468c2ecf20Sopenharmony_ci 2478c2ecf20Sopenharmony_cistatic int reset_control_array_acquire(struct reset_control_array *resets) 2488c2ecf20Sopenharmony_ci{ 2498c2ecf20Sopenharmony_ci unsigned int i; 2508c2ecf20Sopenharmony_ci int err; 2518c2ecf20Sopenharmony_ci 2528c2ecf20Sopenharmony_ci for (i = 0; i < resets->num_rstcs; i++) { 2538c2ecf20Sopenharmony_ci err = reset_control_acquire(resets->rstc[i]); 2548c2ecf20Sopenharmony_ci if (err < 0) 2558c2ecf20Sopenharmony_ci goto release; 2568c2ecf20Sopenharmony_ci } 2578c2ecf20Sopenharmony_ci 2588c2ecf20Sopenharmony_ci return 0; 2598c2ecf20Sopenharmony_ci 2608c2ecf20Sopenharmony_cirelease: 2618c2ecf20Sopenharmony_ci while (i--) 2628c2ecf20Sopenharmony_ci reset_control_release(resets->rstc[i]); 2638c2ecf20Sopenharmony_ci 2648c2ecf20Sopenharmony_ci return err; 2658c2ecf20Sopenharmony_ci} 2668c2ecf20Sopenharmony_ci 2678c2ecf20Sopenharmony_cistatic void reset_control_array_release(struct reset_control_array *resets) 2688c2ecf20Sopenharmony_ci{ 2698c2ecf20Sopenharmony_ci unsigned int i; 2708c2ecf20Sopenharmony_ci 2718c2ecf20Sopenharmony_ci for (i = 0; i < resets->num_rstcs; i++) 2728c2ecf20Sopenharmony_ci reset_control_release(resets->rstc[i]); 2738c2ecf20Sopenharmony_ci} 2748c2ecf20Sopenharmony_ci 2758c2ecf20Sopenharmony_cistatic inline bool reset_control_is_array(struct reset_control *rstc) 2768c2ecf20Sopenharmony_ci{ 2778c2ecf20Sopenharmony_ci return rstc->array; 2788c2ecf20Sopenharmony_ci} 2798c2ecf20Sopenharmony_ci 2808c2ecf20Sopenharmony_ci/** 2818c2ecf20Sopenharmony_ci * reset_control_reset - reset the controlled device 2828c2ecf20Sopenharmony_ci * @rstc: reset controller 2838c2ecf20Sopenharmony_ci * 2848c2ecf20Sopenharmony_ci * On a shared reset line the actual reset pulse is only triggered once for the 2858c2ecf20Sopenharmony_ci * lifetime of the reset_control instance: for all but the first caller this is 2868c2ecf20Sopenharmony_ci * a no-op. 2878c2ecf20Sopenharmony_ci * Consumers must not use reset_control_(de)assert on shared reset lines when 2888c2ecf20Sopenharmony_ci * reset_control_reset has been used. 2898c2ecf20Sopenharmony_ci * 2908c2ecf20Sopenharmony_ci * If rstc is NULL it is an optional reset and the function will just 2918c2ecf20Sopenharmony_ci * return 0. 2928c2ecf20Sopenharmony_ci */ 2938c2ecf20Sopenharmony_ciint reset_control_reset(struct reset_control *rstc) 2948c2ecf20Sopenharmony_ci{ 2958c2ecf20Sopenharmony_ci int ret; 2968c2ecf20Sopenharmony_ci 2978c2ecf20Sopenharmony_ci if (!rstc) 2988c2ecf20Sopenharmony_ci return 0; 2998c2ecf20Sopenharmony_ci 3008c2ecf20Sopenharmony_ci if (WARN_ON(IS_ERR(rstc))) 3018c2ecf20Sopenharmony_ci return -EINVAL; 3028c2ecf20Sopenharmony_ci 3038c2ecf20Sopenharmony_ci if (reset_control_is_array(rstc)) 3048c2ecf20Sopenharmony_ci return reset_control_array_reset(rstc_to_array(rstc)); 3058c2ecf20Sopenharmony_ci 3068c2ecf20Sopenharmony_ci if (!rstc->rcdev->ops->reset) 3078c2ecf20Sopenharmony_ci return -ENOTSUPP; 3088c2ecf20Sopenharmony_ci 3098c2ecf20Sopenharmony_ci if (rstc->shared) { 3108c2ecf20Sopenharmony_ci if (WARN_ON(atomic_read(&rstc->deassert_count) != 0)) 3118c2ecf20Sopenharmony_ci return -EINVAL; 3128c2ecf20Sopenharmony_ci 3138c2ecf20Sopenharmony_ci if (atomic_inc_return(&rstc->triggered_count) != 1) 3148c2ecf20Sopenharmony_ci return 0; 3158c2ecf20Sopenharmony_ci } else { 3168c2ecf20Sopenharmony_ci if (!rstc->acquired) 3178c2ecf20Sopenharmony_ci return -EPERM; 3188c2ecf20Sopenharmony_ci } 3198c2ecf20Sopenharmony_ci 3208c2ecf20Sopenharmony_ci ret = rstc->rcdev->ops->reset(rstc->rcdev, rstc->id); 3218c2ecf20Sopenharmony_ci if (rstc->shared && ret) 3228c2ecf20Sopenharmony_ci atomic_dec(&rstc->triggered_count); 3238c2ecf20Sopenharmony_ci 3248c2ecf20Sopenharmony_ci return ret; 3258c2ecf20Sopenharmony_ci} 3268c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(reset_control_reset); 3278c2ecf20Sopenharmony_ci 3288c2ecf20Sopenharmony_ci/** 3298c2ecf20Sopenharmony_ci * reset_control_assert - asserts the reset line 3308c2ecf20Sopenharmony_ci * @rstc: reset controller 3318c2ecf20Sopenharmony_ci * 3328c2ecf20Sopenharmony_ci * Calling this on an exclusive reset controller guarantees that the reset 3338c2ecf20Sopenharmony_ci * will be asserted. When called on a shared reset controller the line may 3348c2ecf20Sopenharmony_ci * still be deasserted, as long as other users keep it so. 3358c2ecf20Sopenharmony_ci * 3368c2ecf20Sopenharmony_ci * For shared reset controls a driver cannot expect the hw's registers and 3378c2ecf20Sopenharmony_ci * internal state to be reset, but must be prepared for this to happen. 3388c2ecf20Sopenharmony_ci * Consumers must not use reset_control_reset on shared reset lines when 3398c2ecf20Sopenharmony_ci * reset_control_(de)assert has been used. 3408c2ecf20Sopenharmony_ci * 3418c2ecf20Sopenharmony_ci * If rstc is NULL it is an optional reset and the function will just 3428c2ecf20Sopenharmony_ci * return 0. 3438c2ecf20Sopenharmony_ci */ 3448c2ecf20Sopenharmony_ciint reset_control_assert(struct reset_control *rstc) 3458c2ecf20Sopenharmony_ci{ 3468c2ecf20Sopenharmony_ci if (!rstc) 3478c2ecf20Sopenharmony_ci return 0; 3488c2ecf20Sopenharmony_ci 3498c2ecf20Sopenharmony_ci if (WARN_ON(IS_ERR(rstc))) 3508c2ecf20Sopenharmony_ci return -EINVAL; 3518c2ecf20Sopenharmony_ci 3528c2ecf20Sopenharmony_ci if (reset_control_is_array(rstc)) 3538c2ecf20Sopenharmony_ci return reset_control_array_assert(rstc_to_array(rstc)); 3548c2ecf20Sopenharmony_ci 3558c2ecf20Sopenharmony_ci if (rstc->shared) { 3568c2ecf20Sopenharmony_ci if (WARN_ON(atomic_read(&rstc->triggered_count) != 0)) 3578c2ecf20Sopenharmony_ci return -EINVAL; 3588c2ecf20Sopenharmony_ci 3598c2ecf20Sopenharmony_ci if (WARN_ON(atomic_read(&rstc->deassert_count) == 0)) 3608c2ecf20Sopenharmony_ci return -EINVAL; 3618c2ecf20Sopenharmony_ci 3628c2ecf20Sopenharmony_ci if (atomic_dec_return(&rstc->deassert_count) != 0) 3638c2ecf20Sopenharmony_ci return 0; 3648c2ecf20Sopenharmony_ci 3658c2ecf20Sopenharmony_ci /* 3668c2ecf20Sopenharmony_ci * Shared reset controls allow the reset line to be in any state 3678c2ecf20Sopenharmony_ci * after this call, so doing nothing is a valid option. 3688c2ecf20Sopenharmony_ci */ 3698c2ecf20Sopenharmony_ci if (!rstc->rcdev->ops->assert) 3708c2ecf20Sopenharmony_ci return 0; 3718c2ecf20Sopenharmony_ci } else { 3728c2ecf20Sopenharmony_ci /* 3738c2ecf20Sopenharmony_ci * If the reset controller does not implement .assert(), there 3748c2ecf20Sopenharmony_ci * is no way to guarantee that the reset line is asserted after 3758c2ecf20Sopenharmony_ci * this call. 3768c2ecf20Sopenharmony_ci */ 3778c2ecf20Sopenharmony_ci if (!rstc->rcdev->ops->assert) 3788c2ecf20Sopenharmony_ci return -ENOTSUPP; 3798c2ecf20Sopenharmony_ci 3808c2ecf20Sopenharmony_ci if (!rstc->acquired) { 3818c2ecf20Sopenharmony_ci WARN(1, "reset %s (ID: %u) is not acquired\n", 3828c2ecf20Sopenharmony_ci rcdev_name(rstc->rcdev), rstc->id); 3838c2ecf20Sopenharmony_ci return -EPERM; 3848c2ecf20Sopenharmony_ci } 3858c2ecf20Sopenharmony_ci } 3868c2ecf20Sopenharmony_ci 3878c2ecf20Sopenharmony_ci return rstc->rcdev->ops->assert(rstc->rcdev, rstc->id); 3888c2ecf20Sopenharmony_ci} 3898c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(reset_control_assert); 3908c2ecf20Sopenharmony_ci 3918c2ecf20Sopenharmony_ci/** 3928c2ecf20Sopenharmony_ci * reset_control_deassert - deasserts the reset line 3938c2ecf20Sopenharmony_ci * @rstc: reset controller 3948c2ecf20Sopenharmony_ci * 3958c2ecf20Sopenharmony_ci * After calling this function, the reset is guaranteed to be deasserted. 3968c2ecf20Sopenharmony_ci * Consumers must not use reset_control_reset on shared reset lines when 3978c2ecf20Sopenharmony_ci * reset_control_(de)assert has been used. 3988c2ecf20Sopenharmony_ci * 3998c2ecf20Sopenharmony_ci * If rstc is NULL it is an optional reset and the function will just 4008c2ecf20Sopenharmony_ci * return 0. 4018c2ecf20Sopenharmony_ci */ 4028c2ecf20Sopenharmony_ciint reset_control_deassert(struct reset_control *rstc) 4038c2ecf20Sopenharmony_ci{ 4048c2ecf20Sopenharmony_ci if (!rstc) 4058c2ecf20Sopenharmony_ci return 0; 4068c2ecf20Sopenharmony_ci 4078c2ecf20Sopenharmony_ci if (WARN_ON(IS_ERR(rstc))) 4088c2ecf20Sopenharmony_ci return -EINVAL; 4098c2ecf20Sopenharmony_ci 4108c2ecf20Sopenharmony_ci if (reset_control_is_array(rstc)) 4118c2ecf20Sopenharmony_ci return reset_control_array_deassert(rstc_to_array(rstc)); 4128c2ecf20Sopenharmony_ci 4138c2ecf20Sopenharmony_ci if (rstc->shared) { 4148c2ecf20Sopenharmony_ci if (WARN_ON(atomic_read(&rstc->triggered_count) != 0)) 4158c2ecf20Sopenharmony_ci return -EINVAL; 4168c2ecf20Sopenharmony_ci 4178c2ecf20Sopenharmony_ci if (atomic_inc_return(&rstc->deassert_count) != 1) 4188c2ecf20Sopenharmony_ci return 0; 4198c2ecf20Sopenharmony_ci } else { 4208c2ecf20Sopenharmony_ci if (!rstc->acquired) { 4218c2ecf20Sopenharmony_ci WARN(1, "reset %s (ID: %u) is not acquired\n", 4228c2ecf20Sopenharmony_ci rcdev_name(rstc->rcdev), rstc->id); 4238c2ecf20Sopenharmony_ci return -EPERM; 4248c2ecf20Sopenharmony_ci } 4258c2ecf20Sopenharmony_ci } 4268c2ecf20Sopenharmony_ci 4278c2ecf20Sopenharmony_ci /* 4288c2ecf20Sopenharmony_ci * If the reset controller does not implement .deassert(), we assume 4298c2ecf20Sopenharmony_ci * that it handles self-deasserting reset lines via .reset(). In that 4308c2ecf20Sopenharmony_ci * case, the reset lines are deasserted by default. If that is not the 4318c2ecf20Sopenharmony_ci * case, the reset controller driver should implement .deassert() and 4328c2ecf20Sopenharmony_ci * return -ENOTSUPP. 4338c2ecf20Sopenharmony_ci */ 4348c2ecf20Sopenharmony_ci if (!rstc->rcdev->ops->deassert) 4358c2ecf20Sopenharmony_ci return 0; 4368c2ecf20Sopenharmony_ci 4378c2ecf20Sopenharmony_ci return rstc->rcdev->ops->deassert(rstc->rcdev, rstc->id); 4388c2ecf20Sopenharmony_ci} 4398c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(reset_control_deassert); 4408c2ecf20Sopenharmony_ci 4418c2ecf20Sopenharmony_ci/** 4428c2ecf20Sopenharmony_ci * reset_control_status - returns a negative errno if not supported, a 4438c2ecf20Sopenharmony_ci * positive value if the reset line is asserted, or zero if the reset 4448c2ecf20Sopenharmony_ci * line is not asserted or if the desc is NULL (optional reset). 4458c2ecf20Sopenharmony_ci * @rstc: reset controller 4468c2ecf20Sopenharmony_ci */ 4478c2ecf20Sopenharmony_ciint reset_control_status(struct reset_control *rstc) 4488c2ecf20Sopenharmony_ci{ 4498c2ecf20Sopenharmony_ci if (!rstc) 4508c2ecf20Sopenharmony_ci return 0; 4518c2ecf20Sopenharmony_ci 4528c2ecf20Sopenharmony_ci if (WARN_ON(IS_ERR(rstc)) || reset_control_is_array(rstc)) 4538c2ecf20Sopenharmony_ci return -EINVAL; 4548c2ecf20Sopenharmony_ci 4558c2ecf20Sopenharmony_ci if (rstc->rcdev->ops->status) 4568c2ecf20Sopenharmony_ci return rstc->rcdev->ops->status(rstc->rcdev, rstc->id); 4578c2ecf20Sopenharmony_ci 4588c2ecf20Sopenharmony_ci return -ENOTSUPP; 4598c2ecf20Sopenharmony_ci} 4608c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(reset_control_status); 4618c2ecf20Sopenharmony_ci 4628c2ecf20Sopenharmony_ci/** 4638c2ecf20Sopenharmony_ci * reset_control_acquire() - acquires a reset control for exclusive use 4648c2ecf20Sopenharmony_ci * @rstc: reset control 4658c2ecf20Sopenharmony_ci * 4668c2ecf20Sopenharmony_ci * This is used to explicitly acquire a reset control for exclusive use. Note 4678c2ecf20Sopenharmony_ci * that exclusive resets are requested as acquired by default. In order for a 4688c2ecf20Sopenharmony_ci * second consumer to be able to control the reset, the first consumer has to 4698c2ecf20Sopenharmony_ci * release it first. Typically the easiest way to achieve this is to call the 4708c2ecf20Sopenharmony_ci * reset_control_get_exclusive_released() to obtain an instance of the reset 4718c2ecf20Sopenharmony_ci * control. Such reset controls are not acquired by default. 4728c2ecf20Sopenharmony_ci * 4738c2ecf20Sopenharmony_ci * Consumers implementing shared access to an exclusive reset need to follow 4748c2ecf20Sopenharmony_ci * a specific protocol in order to work together. Before consumers can change 4758c2ecf20Sopenharmony_ci * a reset they must acquire exclusive access using reset_control_acquire(). 4768c2ecf20Sopenharmony_ci * After they are done operating the reset, they must release exclusive access 4778c2ecf20Sopenharmony_ci * with a call to reset_control_release(). Consumers are not granted exclusive 4788c2ecf20Sopenharmony_ci * access to the reset as long as another consumer hasn't released a reset. 4798c2ecf20Sopenharmony_ci * 4808c2ecf20Sopenharmony_ci * See also: reset_control_release() 4818c2ecf20Sopenharmony_ci */ 4828c2ecf20Sopenharmony_ciint reset_control_acquire(struct reset_control *rstc) 4838c2ecf20Sopenharmony_ci{ 4848c2ecf20Sopenharmony_ci struct reset_control *rc; 4858c2ecf20Sopenharmony_ci 4868c2ecf20Sopenharmony_ci if (!rstc) 4878c2ecf20Sopenharmony_ci return 0; 4888c2ecf20Sopenharmony_ci 4898c2ecf20Sopenharmony_ci if (WARN_ON(IS_ERR(rstc))) 4908c2ecf20Sopenharmony_ci return -EINVAL; 4918c2ecf20Sopenharmony_ci 4928c2ecf20Sopenharmony_ci if (reset_control_is_array(rstc)) 4938c2ecf20Sopenharmony_ci return reset_control_array_acquire(rstc_to_array(rstc)); 4948c2ecf20Sopenharmony_ci 4958c2ecf20Sopenharmony_ci mutex_lock(&reset_list_mutex); 4968c2ecf20Sopenharmony_ci 4978c2ecf20Sopenharmony_ci if (rstc->acquired) { 4988c2ecf20Sopenharmony_ci mutex_unlock(&reset_list_mutex); 4998c2ecf20Sopenharmony_ci return 0; 5008c2ecf20Sopenharmony_ci } 5018c2ecf20Sopenharmony_ci 5028c2ecf20Sopenharmony_ci list_for_each_entry(rc, &rstc->rcdev->reset_control_head, list) { 5038c2ecf20Sopenharmony_ci if (rstc != rc && rstc->id == rc->id) { 5048c2ecf20Sopenharmony_ci if (rc->acquired) { 5058c2ecf20Sopenharmony_ci mutex_unlock(&reset_list_mutex); 5068c2ecf20Sopenharmony_ci return -EBUSY; 5078c2ecf20Sopenharmony_ci } 5088c2ecf20Sopenharmony_ci } 5098c2ecf20Sopenharmony_ci } 5108c2ecf20Sopenharmony_ci 5118c2ecf20Sopenharmony_ci rstc->acquired = true; 5128c2ecf20Sopenharmony_ci 5138c2ecf20Sopenharmony_ci mutex_unlock(&reset_list_mutex); 5148c2ecf20Sopenharmony_ci return 0; 5158c2ecf20Sopenharmony_ci} 5168c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(reset_control_acquire); 5178c2ecf20Sopenharmony_ci 5188c2ecf20Sopenharmony_ci/** 5198c2ecf20Sopenharmony_ci * reset_control_release() - releases exclusive access to a reset control 5208c2ecf20Sopenharmony_ci * @rstc: reset control 5218c2ecf20Sopenharmony_ci * 5228c2ecf20Sopenharmony_ci * Releases exclusive access right to a reset control previously obtained by a 5238c2ecf20Sopenharmony_ci * call to reset_control_acquire(). Until a consumer calls this function, no 5248c2ecf20Sopenharmony_ci * other consumers will be granted exclusive access. 5258c2ecf20Sopenharmony_ci * 5268c2ecf20Sopenharmony_ci * See also: reset_control_acquire() 5278c2ecf20Sopenharmony_ci */ 5288c2ecf20Sopenharmony_civoid reset_control_release(struct reset_control *rstc) 5298c2ecf20Sopenharmony_ci{ 5308c2ecf20Sopenharmony_ci if (!rstc || WARN_ON(IS_ERR(rstc))) 5318c2ecf20Sopenharmony_ci return; 5328c2ecf20Sopenharmony_ci 5338c2ecf20Sopenharmony_ci if (reset_control_is_array(rstc)) 5348c2ecf20Sopenharmony_ci reset_control_array_release(rstc_to_array(rstc)); 5358c2ecf20Sopenharmony_ci else 5368c2ecf20Sopenharmony_ci rstc->acquired = false; 5378c2ecf20Sopenharmony_ci} 5388c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(reset_control_release); 5398c2ecf20Sopenharmony_ci 5408c2ecf20Sopenharmony_cistatic struct reset_control *__reset_control_get_internal( 5418c2ecf20Sopenharmony_ci struct reset_controller_dev *rcdev, 5428c2ecf20Sopenharmony_ci unsigned int index, bool shared, bool acquired) 5438c2ecf20Sopenharmony_ci{ 5448c2ecf20Sopenharmony_ci struct reset_control *rstc; 5458c2ecf20Sopenharmony_ci 5468c2ecf20Sopenharmony_ci lockdep_assert_held(&reset_list_mutex); 5478c2ecf20Sopenharmony_ci 5488c2ecf20Sopenharmony_ci list_for_each_entry(rstc, &rcdev->reset_control_head, list) { 5498c2ecf20Sopenharmony_ci if (rstc->id == index) { 5508c2ecf20Sopenharmony_ci /* 5518c2ecf20Sopenharmony_ci * Allow creating a secondary exclusive reset_control 5528c2ecf20Sopenharmony_ci * that is initially not acquired for an already 5538c2ecf20Sopenharmony_ci * controlled reset line. 5548c2ecf20Sopenharmony_ci */ 5558c2ecf20Sopenharmony_ci if (!rstc->shared && !shared && !acquired) 5568c2ecf20Sopenharmony_ci break; 5578c2ecf20Sopenharmony_ci 5588c2ecf20Sopenharmony_ci if (WARN_ON(!rstc->shared || !shared)) 5598c2ecf20Sopenharmony_ci return ERR_PTR(-EBUSY); 5608c2ecf20Sopenharmony_ci 5618c2ecf20Sopenharmony_ci kref_get(&rstc->refcnt); 5628c2ecf20Sopenharmony_ci return rstc; 5638c2ecf20Sopenharmony_ci } 5648c2ecf20Sopenharmony_ci } 5658c2ecf20Sopenharmony_ci 5668c2ecf20Sopenharmony_ci rstc = kzalloc(sizeof(*rstc), GFP_KERNEL); 5678c2ecf20Sopenharmony_ci if (!rstc) 5688c2ecf20Sopenharmony_ci return ERR_PTR(-ENOMEM); 5698c2ecf20Sopenharmony_ci 5708c2ecf20Sopenharmony_ci if (!try_module_get(rcdev->owner)) { 5718c2ecf20Sopenharmony_ci kfree(rstc); 5728c2ecf20Sopenharmony_ci return ERR_PTR(-ENODEV); 5738c2ecf20Sopenharmony_ci } 5748c2ecf20Sopenharmony_ci 5758c2ecf20Sopenharmony_ci rstc->rcdev = rcdev; 5768c2ecf20Sopenharmony_ci list_add(&rstc->list, &rcdev->reset_control_head); 5778c2ecf20Sopenharmony_ci rstc->id = index; 5788c2ecf20Sopenharmony_ci kref_init(&rstc->refcnt); 5798c2ecf20Sopenharmony_ci rstc->acquired = acquired; 5808c2ecf20Sopenharmony_ci rstc->shared = shared; 5818c2ecf20Sopenharmony_ci 5828c2ecf20Sopenharmony_ci return rstc; 5838c2ecf20Sopenharmony_ci} 5848c2ecf20Sopenharmony_ci 5858c2ecf20Sopenharmony_cistatic void __reset_control_release(struct kref *kref) 5868c2ecf20Sopenharmony_ci{ 5878c2ecf20Sopenharmony_ci struct reset_control *rstc = container_of(kref, struct reset_control, 5888c2ecf20Sopenharmony_ci refcnt); 5898c2ecf20Sopenharmony_ci 5908c2ecf20Sopenharmony_ci lockdep_assert_held(&reset_list_mutex); 5918c2ecf20Sopenharmony_ci 5928c2ecf20Sopenharmony_ci module_put(rstc->rcdev->owner); 5938c2ecf20Sopenharmony_ci 5948c2ecf20Sopenharmony_ci list_del(&rstc->list); 5958c2ecf20Sopenharmony_ci kfree(rstc); 5968c2ecf20Sopenharmony_ci} 5978c2ecf20Sopenharmony_ci 5988c2ecf20Sopenharmony_cistatic void __reset_control_put_internal(struct reset_control *rstc) 5998c2ecf20Sopenharmony_ci{ 6008c2ecf20Sopenharmony_ci lockdep_assert_held(&reset_list_mutex); 6018c2ecf20Sopenharmony_ci 6028c2ecf20Sopenharmony_ci if (IS_ERR_OR_NULL(rstc)) 6038c2ecf20Sopenharmony_ci return; 6048c2ecf20Sopenharmony_ci 6058c2ecf20Sopenharmony_ci kref_put(&rstc->refcnt, __reset_control_release); 6068c2ecf20Sopenharmony_ci} 6078c2ecf20Sopenharmony_ci 6088c2ecf20Sopenharmony_cistruct reset_control *__of_reset_control_get(struct device_node *node, 6098c2ecf20Sopenharmony_ci const char *id, int index, bool shared, 6108c2ecf20Sopenharmony_ci bool optional, bool acquired) 6118c2ecf20Sopenharmony_ci{ 6128c2ecf20Sopenharmony_ci struct reset_control *rstc; 6138c2ecf20Sopenharmony_ci struct reset_controller_dev *r, *rcdev; 6148c2ecf20Sopenharmony_ci struct of_phandle_args args; 6158c2ecf20Sopenharmony_ci int rstc_id; 6168c2ecf20Sopenharmony_ci int ret; 6178c2ecf20Sopenharmony_ci 6188c2ecf20Sopenharmony_ci if (!node) 6198c2ecf20Sopenharmony_ci return ERR_PTR(-EINVAL); 6208c2ecf20Sopenharmony_ci 6218c2ecf20Sopenharmony_ci if (id) { 6228c2ecf20Sopenharmony_ci index = of_property_match_string(node, 6238c2ecf20Sopenharmony_ci "reset-names", id); 6248c2ecf20Sopenharmony_ci if (index == -EILSEQ) 6258c2ecf20Sopenharmony_ci return ERR_PTR(index); 6268c2ecf20Sopenharmony_ci if (index < 0) 6278c2ecf20Sopenharmony_ci return optional ? NULL : ERR_PTR(-ENOENT); 6288c2ecf20Sopenharmony_ci } 6298c2ecf20Sopenharmony_ci 6308c2ecf20Sopenharmony_ci ret = of_parse_phandle_with_args(node, "resets", "#reset-cells", 6318c2ecf20Sopenharmony_ci index, &args); 6328c2ecf20Sopenharmony_ci if (ret == -EINVAL) 6338c2ecf20Sopenharmony_ci return ERR_PTR(ret); 6348c2ecf20Sopenharmony_ci if (ret) 6358c2ecf20Sopenharmony_ci return optional ? NULL : ERR_PTR(ret); 6368c2ecf20Sopenharmony_ci 6378c2ecf20Sopenharmony_ci mutex_lock(&reset_list_mutex); 6388c2ecf20Sopenharmony_ci rcdev = NULL; 6398c2ecf20Sopenharmony_ci list_for_each_entry(r, &reset_controller_list, list) { 6408c2ecf20Sopenharmony_ci if (args.np == r->of_node) { 6418c2ecf20Sopenharmony_ci rcdev = r; 6428c2ecf20Sopenharmony_ci break; 6438c2ecf20Sopenharmony_ci } 6448c2ecf20Sopenharmony_ci } 6458c2ecf20Sopenharmony_ci 6468c2ecf20Sopenharmony_ci if (!rcdev) { 6478c2ecf20Sopenharmony_ci rstc = ERR_PTR(-EPROBE_DEFER); 6488c2ecf20Sopenharmony_ci goto out; 6498c2ecf20Sopenharmony_ci } 6508c2ecf20Sopenharmony_ci 6518c2ecf20Sopenharmony_ci if (WARN_ON(args.args_count != rcdev->of_reset_n_cells)) { 6528c2ecf20Sopenharmony_ci rstc = ERR_PTR(-EINVAL); 6538c2ecf20Sopenharmony_ci goto out; 6548c2ecf20Sopenharmony_ci } 6558c2ecf20Sopenharmony_ci 6568c2ecf20Sopenharmony_ci rstc_id = rcdev->of_xlate(rcdev, &args); 6578c2ecf20Sopenharmony_ci if (rstc_id < 0) { 6588c2ecf20Sopenharmony_ci rstc = ERR_PTR(rstc_id); 6598c2ecf20Sopenharmony_ci goto out; 6608c2ecf20Sopenharmony_ci } 6618c2ecf20Sopenharmony_ci 6628c2ecf20Sopenharmony_ci /* reset_list_mutex also protects the rcdev's reset_control list */ 6638c2ecf20Sopenharmony_ci rstc = __reset_control_get_internal(rcdev, rstc_id, shared, acquired); 6648c2ecf20Sopenharmony_ci 6658c2ecf20Sopenharmony_ciout: 6668c2ecf20Sopenharmony_ci mutex_unlock(&reset_list_mutex); 6678c2ecf20Sopenharmony_ci of_node_put(args.np); 6688c2ecf20Sopenharmony_ci 6698c2ecf20Sopenharmony_ci return rstc; 6708c2ecf20Sopenharmony_ci} 6718c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(__of_reset_control_get); 6728c2ecf20Sopenharmony_ci 6738c2ecf20Sopenharmony_cistatic struct reset_controller_dev * 6748c2ecf20Sopenharmony_ci__reset_controller_by_name(const char *name) 6758c2ecf20Sopenharmony_ci{ 6768c2ecf20Sopenharmony_ci struct reset_controller_dev *rcdev; 6778c2ecf20Sopenharmony_ci 6788c2ecf20Sopenharmony_ci lockdep_assert_held(&reset_list_mutex); 6798c2ecf20Sopenharmony_ci 6808c2ecf20Sopenharmony_ci list_for_each_entry(rcdev, &reset_controller_list, list) { 6818c2ecf20Sopenharmony_ci if (!rcdev->dev) 6828c2ecf20Sopenharmony_ci continue; 6838c2ecf20Sopenharmony_ci 6848c2ecf20Sopenharmony_ci if (!strcmp(name, dev_name(rcdev->dev))) 6858c2ecf20Sopenharmony_ci return rcdev; 6868c2ecf20Sopenharmony_ci } 6878c2ecf20Sopenharmony_ci 6888c2ecf20Sopenharmony_ci return NULL; 6898c2ecf20Sopenharmony_ci} 6908c2ecf20Sopenharmony_ci 6918c2ecf20Sopenharmony_cistatic struct reset_control * 6928c2ecf20Sopenharmony_ci__reset_control_get_from_lookup(struct device *dev, const char *con_id, 6938c2ecf20Sopenharmony_ci bool shared, bool optional, bool acquired) 6948c2ecf20Sopenharmony_ci{ 6958c2ecf20Sopenharmony_ci const struct reset_control_lookup *lookup; 6968c2ecf20Sopenharmony_ci struct reset_controller_dev *rcdev; 6978c2ecf20Sopenharmony_ci const char *dev_id = dev_name(dev); 6988c2ecf20Sopenharmony_ci struct reset_control *rstc = NULL; 6998c2ecf20Sopenharmony_ci 7008c2ecf20Sopenharmony_ci mutex_lock(&reset_lookup_mutex); 7018c2ecf20Sopenharmony_ci 7028c2ecf20Sopenharmony_ci list_for_each_entry(lookup, &reset_lookup_list, list) { 7038c2ecf20Sopenharmony_ci if (strcmp(lookup->dev_id, dev_id)) 7048c2ecf20Sopenharmony_ci continue; 7058c2ecf20Sopenharmony_ci 7068c2ecf20Sopenharmony_ci if ((!con_id && !lookup->con_id) || 7078c2ecf20Sopenharmony_ci ((con_id && lookup->con_id) && 7088c2ecf20Sopenharmony_ci !strcmp(con_id, lookup->con_id))) { 7098c2ecf20Sopenharmony_ci mutex_lock(&reset_list_mutex); 7108c2ecf20Sopenharmony_ci rcdev = __reset_controller_by_name(lookup->provider); 7118c2ecf20Sopenharmony_ci if (!rcdev) { 7128c2ecf20Sopenharmony_ci mutex_unlock(&reset_list_mutex); 7138c2ecf20Sopenharmony_ci mutex_unlock(&reset_lookup_mutex); 7148c2ecf20Sopenharmony_ci /* Reset provider may not be ready yet. */ 7158c2ecf20Sopenharmony_ci return ERR_PTR(-EPROBE_DEFER); 7168c2ecf20Sopenharmony_ci } 7178c2ecf20Sopenharmony_ci 7188c2ecf20Sopenharmony_ci rstc = __reset_control_get_internal(rcdev, 7198c2ecf20Sopenharmony_ci lookup->index, 7208c2ecf20Sopenharmony_ci shared, acquired); 7218c2ecf20Sopenharmony_ci mutex_unlock(&reset_list_mutex); 7228c2ecf20Sopenharmony_ci break; 7238c2ecf20Sopenharmony_ci } 7248c2ecf20Sopenharmony_ci } 7258c2ecf20Sopenharmony_ci 7268c2ecf20Sopenharmony_ci mutex_unlock(&reset_lookup_mutex); 7278c2ecf20Sopenharmony_ci 7288c2ecf20Sopenharmony_ci if (!rstc) 7298c2ecf20Sopenharmony_ci return optional ? NULL : ERR_PTR(-ENOENT); 7308c2ecf20Sopenharmony_ci 7318c2ecf20Sopenharmony_ci return rstc; 7328c2ecf20Sopenharmony_ci} 7338c2ecf20Sopenharmony_ci 7348c2ecf20Sopenharmony_cistruct reset_control *__reset_control_get(struct device *dev, const char *id, 7358c2ecf20Sopenharmony_ci int index, bool shared, bool optional, 7368c2ecf20Sopenharmony_ci bool acquired) 7378c2ecf20Sopenharmony_ci{ 7388c2ecf20Sopenharmony_ci if (WARN_ON(shared && acquired)) 7398c2ecf20Sopenharmony_ci return ERR_PTR(-EINVAL); 7408c2ecf20Sopenharmony_ci 7418c2ecf20Sopenharmony_ci if (dev->of_node) 7428c2ecf20Sopenharmony_ci return __of_reset_control_get(dev->of_node, id, index, shared, 7438c2ecf20Sopenharmony_ci optional, acquired); 7448c2ecf20Sopenharmony_ci 7458c2ecf20Sopenharmony_ci return __reset_control_get_from_lookup(dev, id, shared, optional, 7468c2ecf20Sopenharmony_ci acquired); 7478c2ecf20Sopenharmony_ci} 7488c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(__reset_control_get); 7498c2ecf20Sopenharmony_ci 7508c2ecf20Sopenharmony_cistatic void reset_control_array_put(struct reset_control_array *resets) 7518c2ecf20Sopenharmony_ci{ 7528c2ecf20Sopenharmony_ci int i; 7538c2ecf20Sopenharmony_ci 7548c2ecf20Sopenharmony_ci mutex_lock(&reset_list_mutex); 7558c2ecf20Sopenharmony_ci for (i = 0; i < resets->num_rstcs; i++) 7568c2ecf20Sopenharmony_ci __reset_control_put_internal(resets->rstc[i]); 7578c2ecf20Sopenharmony_ci mutex_unlock(&reset_list_mutex); 7588c2ecf20Sopenharmony_ci kfree(resets); 7598c2ecf20Sopenharmony_ci} 7608c2ecf20Sopenharmony_ci 7618c2ecf20Sopenharmony_ci/** 7628c2ecf20Sopenharmony_ci * reset_control_put - free the reset controller 7638c2ecf20Sopenharmony_ci * @rstc: reset controller 7648c2ecf20Sopenharmony_ci */ 7658c2ecf20Sopenharmony_civoid reset_control_put(struct reset_control *rstc) 7668c2ecf20Sopenharmony_ci{ 7678c2ecf20Sopenharmony_ci if (IS_ERR_OR_NULL(rstc)) 7688c2ecf20Sopenharmony_ci return; 7698c2ecf20Sopenharmony_ci 7708c2ecf20Sopenharmony_ci if (reset_control_is_array(rstc)) { 7718c2ecf20Sopenharmony_ci reset_control_array_put(rstc_to_array(rstc)); 7728c2ecf20Sopenharmony_ci return; 7738c2ecf20Sopenharmony_ci } 7748c2ecf20Sopenharmony_ci 7758c2ecf20Sopenharmony_ci mutex_lock(&reset_list_mutex); 7768c2ecf20Sopenharmony_ci __reset_control_put_internal(rstc); 7778c2ecf20Sopenharmony_ci mutex_unlock(&reset_list_mutex); 7788c2ecf20Sopenharmony_ci} 7798c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(reset_control_put); 7808c2ecf20Sopenharmony_ci 7818c2ecf20Sopenharmony_cistatic void devm_reset_control_release(struct device *dev, void *res) 7828c2ecf20Sopenharmony_ci{ 7838c2ecf20Sopenharmony_ci reset_control_put(*(struct reset_control **)res); 7848c2ecf20Sopenharmony_ci} 7858c2ecf20Sopenharmony_ci 7868c2ecf20Sopenharmony_cistruct reset_control *__devm_reset_control_get(struct device *dev, 7878c2ecf20Sopenharmony_ci const char *id, int index, bool shared, 7888c2ecf20Sopenharmony_ci bool optional, bool acquired) 7898c2ecf20Sopenharmony_ci{ 7908c2ecf20Sopenharmony_ci struct reset_control **ptr, *rstc; 7918c2ecf20Sopenharmony_ci 7928c2ecf20Sopenharmony_ci ptr = devres_alloc(devm_reset_control_release, sizeof(*ptr), 7938c2ecf20Sopenharmony_ci GFP_KERNEL); 7948c2ecf20Sopenharmony_ci if (!ptr) 7958c2ecf20Sopenharmony_ci return ERR_PTR(-ENOMEM); 7968c2ecf20Sopenharmony_ci 7978c2ecf20Sopenharmony_ci rstc = __reset_control_get(dev, id, index, shared, optional, acquired); 7988c2ecf20Sopenharmony_ci if (IS_ERR_OR_NULL(rstc)) { 7998c2ecf20Sopenharmony_ci devres_free(ptr); 8008c2ecf20Sopenharmony_ci return rstc; 8018c2ecf20Sopenharmony_ci } 8028c2ecf20Sopenharmony_ci 8038c2ecf20Sopenharmony_ci *ptr = rstc; 8048c2ecf20Sopenharmony_ci devres_add(dev, ptr); 8058c2ecf20Sopenharmony_ci 8068c2ecf20Sopenharmony_ci return rstc; 8078c2ecf20Sopenharmony_ci} 8088c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(__devm_reset_control_get); 8098c2ecf20Sopenharmony_ci 8108c2ecf20Sopenharmony_ci/** 8118c2ecf20Sopenharmony_ci * device_reset - find reset controller associated with the device 8128c2ecf20Sopenharmony_ci * and perform reset 8138c2ecf20Sopenharmony_ci * @dev: device to be reset by the controller 8148c2ecf20Sopenharmony_ci * @optional: whether it is optional to reset the device 8158c2ecf20Sopenharmony_ci * 8168c2ecf20Sopenharmony_ci * Convenience wrapper for __reset_control_get() and reset_control_reset(). 8178c2ecf20Sopenharmony_ci * This is useful for the common case of devices with single, dedicated reset 8188c2ecf20Sopenharmony_ci * lines. 8198c2ecf20Sopenharmony_ci */ 8208c2ecf20Sopenharmony_ciint __device_reset(struct device *dev, bool optional) 8218c2ecf20Sopenharmony_ci{ 8228c2ecf20Sopenharmony_ci struct reset_control *rstc; 8238c2ecf20Sopenharmony_ci int ret; 8248c2ecf20Sopenharmony_ci 8258c2ecf20Sopenharmony_ci rstc = __reset_control_get(dev, NULL, 0, 0, optional, true); 8268c2ecf20Sopenharmony_ci if (IS_ERR(rstc)) 8278c2ecf20Sopenharmony_ci return PTR_ERR(rstc); 8288c2ecf20Sopenharmony_ci 8298c2ecf20Sopenharmony_ci ret = reset_control_reset(rstc); 8308c2ecf20Sopenharmony_ci 8318c2ecf20Sopenharmony_ci reset_control_put(rstc); 8328c2ecf20Sopenharmony_ci 8338c2ecf20Sopenharmony_ci return ret; 8348c2ecf20Sopenharmony_ci} 8358c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(__device_reset); 8368c2ecf20Sopenharmony_ci 8378c2ecf20Sopenharmony_ci/* 8388c2ecf20Sopenharmony_ci * APIs to manage an array of reset controls. 8398c2ecf20Sopenharmony_ci */ 8408c2ecf20Sopenharmony_ci 8418c2ecf20Sopenharmony_ci/** 8428c2ecf20Sopenharmony_ci * of_reset_control_get_count - Count number of resets available with a device 8438c2ecf20Sopenharmony_ci * 8448c2ecf20Sopenharmony_ci * @node: device node that contains 'resets'. 8458c2ecf20Sopenharmony_ci * 8468c2ecf20Sopenharmony_ci * Returns positive reset count on success, or error number on failure and 8478c2ecf20Sopenharmony_ci * on count being zero. 8488c2ecf20Sopenharmony_ci */ 8498c2ecf20Sopenharmony_cistatic int of_reset_control_get_count(struct device_node *node) 8508c2ecf20Sopenharmony_ci{ 8518c2ecf20Sopenharmony_ci int count; 8528c2ecf20Sopenharmony_ci 8538c2ecf20Sopenharmony_ci if (!node) 8548c2ecf20Sopenharmony_ci return -EINVAL; 8558c2ecf20Sopenharmony_ci 8568c2ecf20Sopenharmony_ci count = of_count_phandle_with_args(node, "resets", "#reset-cells"); 8578c2ecf20Sopenharmony_ci if (count == 0) 8588c2ecf20Sopenharmony_ci count = -ENOENT; 8598c2ecf20Sopenharmony_ci 8608c2ecf20Sopenharmony_ci return count; 8618c2ecf20Sopenharmony_ci} 8628c2ecf20Sopenharmony_ci 8638c2ecf20Sopenharmony_ci/** 8648c2ecf20Sopenharmony_ci * of_reset_control_array_get - Get a list of reset controls using 8658c2ecf20Sopenharmony_ci * device node. 8668c2ecf20Sopenharmony_ci * 8678c2ecf20Sopenharmony_ci * @np: device node for the device that requests the reset controls array 8688c2ecf20Sopenharmony_ci * @shared: whether reset controls are shared or not 8698c2ecf20Sopenharmony_ci * @optional: whether it is optional to get the reset controls 8708c2ecf20Sopenharmony_ci * @acquired: only one reset control may be acquired for a given controller 8718c2ecf20Sopenharmony_ci * and ID 8728c2ecf20Sopenharmony_ci * 8738c2ecf20Sopenharmony_ci * Returns pointer to allocated reset_control on success or error on failure 8748c2ecf20Sopenharmony_ci */ 8758c2ecf20Sopenharmony_cistruct reset_control * 8768c2ecf20Sopenharmony_ciof_reset_control_array_get(struct device_node *np, bool shared, bool optional, 8778c2ecf20Sopenharmony_ci bool acquired) 8788c2ecf20Sopenharmony_ci{ 8798c2ecf20Sopenharmony_ci struct reset_control_array *resets; 8808c2ecf20Sopenharmony_ci struct reset_control *rstc; 8818c2ecf20Sopenharmony_ci int num, i; 8828c2ecf20Sopenharmony_ci 8838c2ecf20Sopenharmony_ci num = of_reset_control_get_count(np); 8848c2ecf20Sopenharmony_ci if (num < 0) 8858c2ecf20Sopenharmony_ci return optional ? NULL : ERR_PTR(num); 8868c2ecf20Sopenharmony_ci 8878c2ecf20Sopenharmony_ci resets = kzalloc(struct_size(resets, rstc, num), GFP_KERNEL); 8888c2ecf20Sopenharmony_ci if (!resets) 8898c2ecf20Sopenharmony_ci return ERR_PTR(-ENOMEM); 8908c2ecf20Sopenharmony_ci 8918c2ecf20Sopenharmony_ci for (i = 0; i < num; i++) { 8928c2ecf20Sopenharmony_ci rstc = __of_reset_control_get(np, NULL, i, shared, optional, 8938c2ecf20Sopenharmony_ci acquired); 8948c2ecf20Sopenharmony_ci if (IS_ERR(rstc)) 8958c2ecf20Sopenharmony_ci goto err_rst; 8968c2ecf20Sopenharmony_ci resets->rstc[i] = rstc; 8978c2ecf20Sopenharmony_ci } 8988c2ecf20Sopenharmony_ci resets->num_rstcs = num; 8998c2ecf20Sopenharmony_ci resets->base.array = true; 9008c2ecf20Sopenharmony_ci 9018c2ecf20Sopenharmony_ci return &resets->base; 9028c2ecf20Sopenharmony_ci 9038c2ecf20Sopenharmony_cierr_rst: 9048c2ecf20Sopenharmony_ci mutex_lock(&reset_list_mutex); 9058c2ecf20Sopenharmony_ci while (--i >= 0) 9068c2ecf20Sopenharmony_ci __reset_control_put_internal(resets->rstc[i]); 9078c2ecf20Sopenharmony_ci mutex_unlock(&reset_list_mutex); 9088c2ecf20Sopenharmony_ci 9098c2ecf20Sopenharmony_ci kfree(resets); 9108c2ecf20Sopenharmony_ci 9118c2ecf20Sopenharmony_ci return rstc; 9128c2ecf20Sopenharmony_ci} 9138c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(of_reset_control_array_get); 9148c2ecf20Sopenharmony_ci 9158c2ecf20Sopenharmony_ci/** 9168c2ecf20Sopenharmony_ci * devm_reset_control_array_get - Resource managed reset control array get 9178c2ecf20Sopenharmony_ci * 9188c2ecf20Sopenharmony_ci * @dev: device that requests the list of reset controls 9198c2ecf20Sopenharmony_ci * @shared: whether reset controls are shared or not 9208c2ecf20Sopenharmony_ci * @optional: whether it is optional to get the reset controls 9218c2ecf20Sopenharmony_ci * 9228c2ecf20Sopenharmony_ci * The reset control array APIs are intended for a list of resets 9238c2ecf20Sopenharmony_ci * that just have to be asserted or deasserted, without any 9248c2ecf20Sopenharmony_ci * requirements on the order. 9258c2ecf20Sopenharmony_ci * 9268c2ecf20Sopenharmony_ci * Returns pointer to allocated reset_control on success or error on failure 9278c2ecf20Sopenharmony_ci */ 9288c2ecf20Sopenharmony_cistruct reset_control * 9298c2ecf20Sopenharmony_cidevm_reset_control_array_get(struct device *dev, bool shared, bool optional) 9308c2ecf20Sopenharmony_ci{ 9318c2ecf20Sopenharmony_ci struct reset_control **ptr, *rstc; 9328c2ecf20Sopenharmony_ci 9338c2ecf20Sopenharmony_ci ptr = devres_alloc(devm_reset_control_release, sizeof(*ptr), 9348c2ecf20Sopenharmony_ci GFP_KERNEL); 9358c2ecf20Sopenharmony_ci if (!ptr) 9368c2ecf20Sopenharmony_ci return ERR_PTR(-ENOMEM); 9378c2ecf20Sopenharmony_ci 9388c2ecf20Sopenharmony_ci rstc = of_reset_control_array_get(dev->of_node, shared, optional, true); 9398c2ecf20Sopenharmony_ci if (IS_ERR_OR_NULL(rstc)) { 9408c2ecf20Sopenharmony_ci devres_free(ptr); 9418c2ecf20Sopenharmony_ci return rstc; 9428c2ecf20Sopenharmony_ci } 9438c2ecf20Sopenharmony_ci 9448c2ecf20Sopenharmony_ci *ptr = rstc; 9458c2ecf20Sopenharmony_ci devres_add(dev, ptr); 9468c2ecf20Sopenharmony_ci 9478c2ecf20Sopenharmony_ci return rstc; 9488c2ecf20Sopenharmony_ci} 9498c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(devm_reset_control_array_get); 9508c2ecf20Sopenharmony_ci 9518c2ecf20Sopenharmony_cistatic int reset_control_get_count_from_lookup(struct device *dev) 9528c2ecf20Sopenharmony_ci{ 9538c2ecf20Sopenharmony_ci const struct reset_control_lookup *lookup; 9548c2ecf20Sopenharmony_ci const char *dev_id; 9558c2ecf20Sopenharmony_ci int count = 0; 9568c2ecf20Sopenharmony_ci 9578c2ecf20Sopenharmony_ci if (!dev) 9588c2ecf20Sopenharmony_ci return -EINVAL; 9598c2ecf20Sopenharmony_ci 9608c2ecf20Sopenharmony_ci dev_id = dev_name(dev); 9618c2ecf20Sopenharmony_ci mutex_lock(&reset_lookup_mutex); 9628c2ecf20Sopenharmony_ci 9638c2ecf20Sopenharmony_ci list_for_each_entry(lookup, &reset_lookup_list, list) { 9648c2ecf20Sopenharmony_ci if (!strcmp(lookup->dev_id, dev_id)) 9658c2ecf20Sopenharmony_ci count++; 9668c2ecf20Sopenharmony_ci } 9678c2ecf20Sopenharmony_ci 9688c2ecf20Sopenharmony_ci mutex_unlock(&reset_lookup_mutex); 9698c2ecf20Sopenharmony_ci 9708c2ecf20Sopenharmony_ci if (count == 0) 9718c2ecf20Sopenharmony_ci count = -ENOENT; 9728c2ecf20Sopenharmony_ci 9738c2ecf20Sopenharmony_ci return count; 9748c2ecf20Sopenharmony_ci} 9758c2ecf20Sopenharmony_ci 9768c2ecf20Sopenharmony_ci/** 9778c2ecf20Sopenharmony_ci * reset_control_get_count - Count number of resets available with a device 9788c2ecf20Sopenharmony_ci * 9798c2ecf20Sopenharmony_ci * @dev: device for which to return the number of resets 9808c2ecf20Sopenharmony_ci * 9818c2ecf20Sopenharmony_ci * Returns positive reset count on success, or error number on failure and 9828c2ecf20Sopenharmony_ci * on count being zero. 9838c2ecf20Sopenharmony_ci */ 9848c2ecf20Sopenharmony_ciint reset_control_get_count(struct device *dev) 9858c2ecf20Sopenharmony_ci{ 9868c2ecf20Sopenharmony_ci if (dev->of_node) 9878c2ecf20Sopenharmony_ci return of_reset_control_get_count(dev->of_node); 9888c2ecf20Sopenharmony_ci 9898c2ecf20Sopenharmony_ci return reset_control_get_count_from_lookup(dev); 9908c2ecf20Sopenharmony_ci} 9918c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(reset_control_get_count); 992