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