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 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 69 static int kpss_xcc_driver_remove(struct platform_device *pdev) 70 { 71 clk_unregister_mux(platform_get_drvdata(pdev)); 72 return 0; 73 } 74 75 static 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 }; 83 module_platform_driver(kpss_xcc_driver); 84 85 MODULE_DESCRIPTION("Krait Processor Sub System (KPSS) Clock Driver"); 86 MODULE_LICENSE("GPL v2"); 87 MODULE_ALIAS("platform:kpss-xcc"); 88