1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Copyright (c) 2024 Collabora Ltd. 4 * Author: Sebastian Reichel <sebastian.reichel@collabora.com> 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 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 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 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