1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Copyright (c) 2024 Collabora Ltd.
4 * Author: Sebastian Reichel <[email protected]>
5 */
6
7 #include <linux/clk.h>
8 #include <linux/platform_device.h>
9 #include <linux/pm_clock.h>
10 #include <linux/pm_runtime.h>
11 #include <linux/property.h>
12 #include "clk.h"
13
rk_clk_gate_link_register(struct device * dev,struct rockchip_clk_provider * ctx,struct rockchip_clk_branch * clkbr)14 static int rk_clk_gate_link_register(struct device *dev,
15 struct rockchip_clk_provider *ctx,
16 struct rockchip_clk_branch *clkbr)
17 {
18 unsigned long flags = clkbr->flags | CLK_SET_RATE_PARENT;
19 struct clk *clk;
20
21 clk = clk_register_gate(dev, clkbr->name, clkbr->parent_names[0],
22 flags, ctx->reg_base + clkbr->gate_offset,
23 clkbr->gate_shift, clkbr->gate_flags,
24 &ctx->lock);
25
26 if (IS_ERR(clk))
27 return PTR_ERR(clk);
28
29 rockchip_clk_set_lookup(ctx, clk, clkbr->id);
30 return 0;
31 }
32
rk_clk_gate_link_probe(struct platform_device * pdev)33 static int rk_clk_gate_link_probe(struct platform_device *pdev)
34 {
35 struct rockchip_gate_link_platdata *pdata;
36 struct device *dev = &pdev->dev;
37 struct clk *linked_clk;
38 int ret;
39
40 pdata = dev_get_platdata(dev);
41 if (!pdata)
42 return dev_err_probe(dev, -ENODEV, "missing platform data");
43
44 ret = devm_pm_runtime_enable(dev);
45 if (ret)
46 return ret;
47
48 ret = devm_pm_clk_create(dev);
49 if (ret)
50 return ret;
51
52 linked_clk = rockchip_clk_get_lookup(pdata->ctx, pdata->clkbr->linked_clk_id);
53 ret = pm_clk_add_clk(dev, linked_clk);
54 if (ret)
55 return ret;
56
57 ret = rk_clk_gate_link_register(dev, pdata->ctx, pdata->clkbr);
58 if (ret)
59 goto err;
60
61 return 0;
62
63 err:
64 pm_clk_remove_clk(dev, linked_clk);
65 return ret;
66 }
67
68 static const struct dev_pm_ops rk_clk_gate_link_pm_ops = {
69 SET_RUNTIME_PM_OPS(pm_clk_suspend, pm_clk_resume, NULL)
70 };
71
72 static struct platform_driver rk_clk_gate_link_driver = {
73 .probe = rk_clk_gate_link_probe,
74 .driver = {
75 .name = "rockchip-gate-link-clk",
76 .pm = &rk_clk_gate_link_pm_ops,
77 .suppress_bind_attrs = true,
78 },
79 };
80
rk_clk_gate_link_drv_register(void)81 static int __init rk_clk_gate_link_drv_register(void)
82 {
83 return platform_driver_register(&rk_clk_gate_link_driver);
84 }
85 core_initcall(rk_clk_gate_link_drv_register);
86