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 char *aux_parents[] = {
16 "pll8_vote",
17 "pxo",
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 const struct of_device_id *id;
35 struct clk *clk;
36 void __iomem *base;
37 const char *name;
38
39 id = of_match_device(kpss_xcc_match_table, &pdev->dev);
40 if (!id)
41 return -ENODEV;
42
43 base = devm_platform_ioremap_resource(pdev, 0);
44 if (IS_ERR(base))
45 return PTR_ERR(base);
46
47 if (id->data) {
48 if (of_property_read_string_index(pdev->dev.of_node,
49 "clock-output-names",
50 0, &name))
51 return -ENODEV;
52 base += 0x14;
53 } else {
54 name = "acpu_l2_aux";
55 base += 0x28;
56 }
57
58 clk = clk_register_mux_table(&pdev->dev, name, aux_parents,
59 ARRAY_SIZE(aux_parents), 0, base, 0, 0x3,
60 0, aux_parent_map, NULL);
61
62 platform_set_drvdata(pdev, clk);
63
64 return PTR_ERR_OR_ZERO(clk);
65 }
66
kpss_xcc_driver_remove(struct platform_device * pdev)67 static int kpss_xcc_driver_remove(struct platform_device *pdev)
68 {
69 clk_unregister_mux(platform_get_drvdata(pdev));
70 return 0;
71 }
72
73 static struct platform_driver kpss_xcc_driver = {
74 .probe = kpss_xcc_driver_probe,
75 .remove = kpss_xcc_driver_remove,
76 .driver = {
77 .name = "kpss-xcc",
78 .of_match_table = kpss_xcc_match_table,
79 },
80 };
81 module_platform_driver(kpss_xcc_driver);
82
83 MODULE_DESCRIPTION("Krait Processor Sub System (KPSS) Clock Driver");
84 MODULE_LICENSE("GPL v2");
85 MODULE_ALIAS("platform:kpss-xcc");
86