drivers/clk/qcom/kpss-xcc.c

   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 unsigned int 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
  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
  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");