1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Copyright (c) 2023 Rockchip Electronics Co., Ltd
4 */
5
6 #include <linux/clk-provider.h>
7 #include <linux/io.h>
8 #include <linux/module.h>
9 #include <linux/of_address.h>
10 #include <linux/platform_device.h>
11 #include <linux/pm_runtime.h>
12
13 static DEFINE_SPINLOCK(clk_out_lock);
14
rockchip_clk_out_probe(struct platform_device * pdev)15 static int rockchip_clk_out_probe(struct platform_device *pdev)
16 {
17 struct device *dev = &pdev->dev;
18 struct device_node *node = pdev->dev.of_node;
19 struct clk_hw *hw;
20 struct resource *res;
21 const char *clk_name = node->name;
22 const char *parent_name;
23 void __iomem *reg;
24 u32 shift = 0;
25 u8 clk_gate_flags = CLK_GATE_HIWORD_MASK;
26 int ret;
27
28 ret = device_property_read_string(dev, "clock-output-names", &clk_name);
29 if (ret)
30 return ret;
31
32 ret = device_property_read_u32(dev, "rockchip,bit-shift", &shift);
33 if (ret)
34 return ret;
35
36 if (device_property_read_bool(dev, "rockchip,bit-set-to-disable"))
37 clk_gate_flags |= CLK_GATE_SET_TO_DISABLE;
38
39 ret = of_clk_parent_fill(node, &parent_name, 1);
40 if (ret != 1)
41 return -EINVAL;
42
43 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
44 if (!res)
45 return -ENOMEM;
46
47 reg = devm_ioremap(dev, res->start, resource_size(res));
48 if (!reg)
49 return -ENOMEM;
50
51 pm_runtime_enable(dev);
52
53 hw = clk_hw_register_gate(dev, clk_name, parent_name, CLK_SET_RATE_PARENT | CLK_IGNORE_UNUSED,
54 reg, shift, clk_gate_flags, &clk_out_lock);
55 if (IS_ERR(hw)) {
56 ret = -EINVAL;
57 goto err_disable_pm_runtime;
58 }
59
60 of_clk_add_hw_provider(node, of_clk_hw_simple_get, hw);
61
62 return 0;
63
64 err_disable_pm_runtime:
65 pm_runtime_disable(dev);
66
67 return ret;
68 }
69
rockchip_clk_out_remove(struct platform_device * pdev)70 static int rockchip_clk_out_remove(struct platform_device *pdev)
71 {
72 struct device_node *node = pdev->dev.of_node;
73
74 of_clk_del_provider(node);
75 pm_runtime_disable(&pdev->dev);
76
77 return 0;
78 }
79
80 static const struct of_device_id rockchip_clk_out_match[] = {
81 { .compatible = "rockchip,clk-out", },
82 {},
83 };
84
85 static struct platform_driver rockchip_clk_out_driver = {
86 .driver = {
87 .name = "rockchip-clk-out",
88 .of_match_table = rockchip_clk_out_match,
89 },
90 .probe = rockchip_clk_out_probe,
91 .remove = rockchip_clk_out_remove,
92 };
93
94 module_platform_driver(rockchip_clk_out_driver);
95
96 MODULE_DESCRIPTION("Rockchip Clock Input-Output-Switch");
97 MODULE_AUTHOR("Sugar Zhang <sugar.zhang@rock-chips.com>");
98 MODULE_LICENSE("GPL");
99 MODULE_DEVICE_TABLE(of, rockchip_clk_out_match);
100