1 // SPDX-License-Identifier: GPL-2.0-only 2 // Copyright (c) 2022, The Linux Foundation. All rights reserved. 3 4 #include <linux/export.h> 5 #include <linux/module.h> 6 #include <linux/init.h> 7 #include <linux/of_platform.h> 8 #include <linux/platform_device.h> 9 #include <linux/pm_domain.h> 10 #include <linux/pm_runtime.h> 11 12 #include "lpass-macro-common.h" 13 14 struct lpass_macro *lpass_macro_pds_init(struct device *dev) 15 { 16 struct lpass_macro *l_pds; 17 int ret; 18 19 if (!of_find_property(dev->of_node, "power-domains", NULL)) 20 return NULL; 21 22 l_pds = devm_kzalloc(dev, sizeof(*l_pds), GFP_KERNEL); 23 if (!l_pds) 24 return ERR_PTR(-ENOMEM); 25 26 l_pds->macro_pd = dev_pm_domain_attach_by_name(dev, "macro"); 27 if (IS_ERR_OR_NULL(l_pds->macro_pd)) { 28 ret = l_pds->macro_pd ? PTR_ERR(l_pds->macro_pd) : -ENODATA; 29 goto macro_err; 30 } 31 32 ret = pm_runtime_resume_and_get(l_pds->macro_pd); 33 if (ret < 0) 34 goto macro_sync_err; 35 36 l_pds->dcodec_pd = dev_pm_domain_attach_by_name(dev, "dcodec"); 37 if (IS_ERR_OR_NULL(l_pds->dcodec_pd)) { 38 ret = l_pds->dcodec_pd ? PTR_ERR(l_pds->dcodec_pd) : -ENODATA; 39 goto dcodec_err; 40 } 41 42 ret = pm_runtime_resume_and_get(l_pds->dcodec_pd); 43 if (ret < 0) 44 goto dcodec_sync_err; 45 return l_pds; 46 47 dcodec_sync_err: 48 dev_pm_domain_detach(l_pds->dcodec_pd, false); 49 dcodec_err: 50 pm_runtime_put(l_pds->macro_pd); 51 macro_sync_err: 52 dev_pm_domain_detach(l_pds->macro_pd, false); 53 macro_err: 54 return ERR_PTR(ret); 55 } 56 EXPORT_SYMBOL_GPL(lpass_macro_pds_init); 57 58 void lpass_macro_pds_exit(struct lpass_macro *pds) 59 { 60 if (pds) { 61 pm_runtime_put(pds->macro_pd); 62 dev_pm_domain_detach(pds->macro_pd, false); 63 pm_runtime_put(pds->dcodec_pd); 64 dev_pm_domain_detach(pds->dcodec_pd, false); 65 } 66 } 67 EXPORT_SYMBOL_GPL(lpass_macro_pds_exit); 68 69 MODULE_DESCRIPTION("Common macro driver"); 70 MODULE_LICENSE("GPL"); 71