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.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
lpass_macro_pds_init(struct device * dev)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_property_present(dev->of_node, "power-domains"))
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
lpass_macro_pds_exit(struct lpass_macro * pds)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