drivers/clk/rockchip/gate-link.c

   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
  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);