1 // SPDX-License-Identifier: GPL-2.0
2 // Copyright (c) 2018, The Linux Foundation. All rights reserved.
3
4 #include <linux/kernel.h>
5 #include <linux/init.h>
6 #include <linux/module.h>
7 #include <linux/platform_device.h>
8 #include <linux/err.h>
9 #include <linux/io.h>
10 #include <linux/of.h>
11 #include <linux/of_device.h>
12 #include <linux/clk.h>
13 #include <linux/clk-provider.h>
14
15 static const struct clk_parent_data aux_parents[] = {
16 { .fw_name = "pll8_vote", .name = "pll8_vote" },
17 { .fw_name = "pxo", .name = "pxo_board" },
18 };
19
20 static const u32 aux_parent_map[] = {
21 3,
22 0,
23 };
24
25 static const struct of_device_id kpss_xcc_match_table[] = {
26 { .compatible = "qcom,kpss-acc-v1", .data = (void *)1UL },
27 { .compatible = "qcom,kpss-gcc" },
28 {}
29 };
30 MODULE_DEVICE_TABLE(of, kpss_xcc_match_table);
31
kpss_xcc_driver_probe(struct platform_device * pdev)32 static int kpss_xcc_driver_probe(struct platform_device *pdev)
33 {
34 struct device *dev = &pdev->dev;
35 const struct of_device_id *id;
36 void __iomem *base;
37 struct clk_hw *hw;
38 const char *name;
39
40 id = of_match_device(kpss_xcc_match_table, dev);
41 if (!id)
42 return -ENODEV;
43
44 base = devm_platform_ioremap_resource(pdev, 0);
45 if (IS_ERR(base))
46 return PTR_ERR(base);
47
48 if (id->data) {
49 if (of_property_read_string_index(dev->of_node,
50 "clock-output-names",
51 0, &name))
52 return -ENODEV;
53 base += 0x14;
54 } else {
55 name = "acpu_l2_aux";
56 base += 0x28;
57 }
58
59 hw = devm_clk_hw_register_mux_parent_data_table(dev, name, aux_parents,
60 ARRAY_SIZE(aux_parents), 0,
61 base, 0, 0x3,
62 0, aux_parent_map, NULL);
63 if (IS_ERR(hw))
64 return PTR_ERR(hw);
65
66 of_clk_add_hw_provider(dev->of_node, of_clk_hw_simple_get, hw);
67
68 return 0;
69 }
70
71 static struct platform_driver kpss_xcc_driver = {
72 .probe = kpss_xcc_driver_probe,
73 .driver = {
74 .name = "kpss-xcc",
75 .of_match_table = kpss_xcc_match_table,
76 },
77 };
78 module_platform_driver(kpss_xcc_driver);
79
80 MODULE_DESCRIPTION("Krait Processor Sub System (KPSS) Clock Driver");
81 MODULE_LICENSE("GPL v2");
82 MODULE_ALIAS("platform:kpss-xcc");
83