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
14struct 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
47dcodec_sync_err:
48	dev_pm_domain_detach(l_pds->dcodec_pd, false);
49dcodec_err:
50	pm_runtime_put(l_pds->macro_pd);
51macro_sync_err:
52	dev_pm_domain_detach(l_pds->macro_pd, false);
53macro_err:
54	return ERR_PTR(ret);
55}
56EXPORT_SYMBOL_GPL(lpass_macro_pds_init);
57
58void 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}
67EXPORT_SYMBOL_GPL(lpass_macro_pds_exit);
68
69MODULE_DESCRIPTION("Common macro driver");
70MODULE_LICENSE("GPL");

 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
14struct 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
47dcodec_sync_err:
48	dev_pm_domain_detach(l_pds->dcodec_pd, false);
49dcodec_err:
50	pm_runtime_put(l_pds->macro_pd);
51macro_sync_err:
52	dev_pm_domain_detach(l_pds->macro_pd, false);
53macro_err:
54	return ERR_PTR(ret);
55}
56EXPORT_SYMBOL_GPL(lpass_macro_pds_init);
57
58void 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}
67EXPORT_SYMBOL_GPL(lpass_macro_pds_exit);
68
69MODULE_DESCRIPTION("Common macro driver");
70MODULE_LICENSE("GPL");