14c02c9afSAngeloGioacchino Del Regno // SPDX-License-Identifier: GPL-2.0-only 24c02c9afSAngeloGioacchino Del Regno /* 34c02c9afSAngeloGioacchino Del Regno * Copyright (c) 2014 MediaTek Inc. 44c02c9afSAngeloGioacchino Del Regno * Copyright (c) 2022 Collabora Ltd. 54c02c9afSAngeloGioacchino Del Regno * Author: AngeloGioacchino Del Regno <angelogioacchino.delregno@collabora.com> 64c02c9afSAngeloGioacchino Del Regno */ 74c02c9afSAngeloGioacchino Del Regno 84c02c9afSAngeloGioacchino Del Regno #include <dt-bindings/clock/mt8173-clk.h> 94c02c9afSAngeloGioacchino Del Regno #include <linux/module.h> 104c02c9afSAngeloGioacchino Del Regno #include <linux/platform_device.h> 114c02c9afSAngeloGioacchino Del Regno #include "clk-cpumux.h" 124c02c9afSAngeloGioacchino Del Regno #include "clk-gate.h" 134c02c9afSAngeloGioacchino Del Regno #include "clk-mtk.h" 144c02c9afSAngeloGioacchino Del Regno #include "reset.h" 154c02c9afSAngeloGioacchino Del Regno 164c02c9afSAngeloGioacchino Del Regno #define GATE_ICG(_id, _name, _parent, _shift) \ 174c02c9afSAngeloGioacchino Del Regno GATE_MTK(_id, _name, _parent, &infra_cg_regs, \ 184c02c9afSAngeloGioacchino Del Regno _shift, &mtk_clk_gate_ops_setclr) 194c02c9afSAngeloGioacchino Del Regno 204c02c9afSAngeloGioacchino Del Regno static struct clk_hw_onecell_data *infra_clk_data; 214c02c9afSAngeloGioacchino Del Regno 224c02c9afSAngeloGioacchino Del Regno static const struct mtk_gate_regs infra_cg_regs = { 234c02c9afSAngeloGioacchino Del Regno .set_ofs = 0x0040, 244c02c9afSAngeloGioacchino Del Regno .clr_ofs = 0x0044, 254c02c9afSAngeloGioacchino Del Regno .sta_ofs = 0x0048, 264c02c9afSAngeloGioacchino Del Regno }; 274c02c9afSAngeloGioacchino Del Regno 284c02c9afSAngeloGioacchino Del Regno static const char * const ca53_parents[] __initconst = { 294c02c9afSAngeloGioacchino Del Regno "clk26m", 304c02c9afSAngeloGioacchino Del Regno "armca7pll", 314c02c9afSAngeloGioacchino Del Regno "mainpll", 324c02c9afSAngeloGioacchino Del Regno "univpll" 334c02c9afSAngeloGioacchino Del Regno }; 344c02c9afSAngeloGioacchino Del Regno 354c02c9afSAngeloGioacchino Del Regno static const char * const ca72_parents[] __initconst = { 364c02c9afSAngeloGioacchino Del Regno "clk26m", 374c02c9afSAngeloGioacchino Del Regno "armca15pll", 384c02c9afSAngeloGioacchino Del Regno "mainpll", 394c02c9afSAngeloGioacchino Del Regno "univpll" 404c02c9afSAngeloGioacchino Del Regno }; 414c02c9afSAngeloGioacchino Del Regno 424c02c9afSAngeloGioacchino Del Regno static const struct mtk_composite cpu_muxes[] = { 434c02c9afSAngeloGioacchino Del Regno MUX(CLK_INFRA_CA53SEL, "infra_ca53_sel", ca53_parents, 0x0000, 0, 2), 444c02c9afSAngeloGioacchino Del Regno MUX(CLK_INFRA_CA72SEL, "infra_ca72_sel", ca72_parents, 0x0000, 2, 2), 454c02c9afSAngeloGioacchino Del Regno }; 464c02c9afSAngeloGioacchino Del Regno 474c02c9afSAngeloGioacchino Del Regno static const struct mtk_fixed_factor infra_early_divs[] = { 484c02c9afSAngeloGioacchino Del Regno FACTOR(CLK_INFRA_CLK_13M, "clk13m", "clk26m", 1, 2), 494c02c9afSAngeloGioacchino Del Regno }; 504c02c9afSAngeloGioacchino Del Regno 514c02c9afSAngeloGioacchino Del Regno static const struct mtk_gate infra_gates[] = { 524c02c9afSAngeloGioacchino Del Regno GATE_ICG(CLK_INFRA_DBGCLK, "infra_dbgclk", "axi_sel", 0), 534c02c9afSAngeloGioacchino Del Regno GATE_ICG(CLK_INFRA_SMI, "infra_smi", "mm_sel", 1), 544c02c9afSAngeloGioacchino Del Regno GATE_ICG(CLK_INFRA_AUDIO, "infra_audio", "aud_intbus_sel", 5), 554c02c9afSAngeloGioacchino Del Regno GATE_ICG(CLK_INFRA_GCE, "infra_gce", "axi_sel", 6), 564c02c9afSAngeloGioacchino Del Regno GATE_ICG(CLK_INFRA_L2C_SRAM, "infra_l2c_sram", "axi_sel", 7), 574c02c9afSAngeloGioacchino Del Regno GATE_ICG(CLK_INFRA_M4U, "infra_m4u", "mem_sel", 8), 584c02c9afSAngeloGioacchino Del Regno GATE_ICG(CLK_INFRA_CPUM, "infra_cpum", "cpum_ck", 15), 594c02c9afSAngeloGioacchino Del Regno GATE_ICG(CLK_INFRA_KP, "infra_kp", "axi_sel", 16), 604c02c9afSAngeloGioacchino Del Regno GATE_ICG(CLK_INFRA_CEC, "infra_cec", "clk26m", 18), 614c02c9afSAngeloGioacchino Del Regno GATE_ICG(CLK_INFRA_PMICSPI, "infra_pmicspi", "pmicspi_sel", 22), 624c02c9afSAngeloGioacchino Del Regno GATE_ICG(CLK_INFRA_PMICWRAP, "infra_pmicwrap", "axi_sel", 23), 634c02c9afSAngeloGioacchino Del Regno }; 644c02c9afSAngeloGioacchino Del Regno 654c02c9afSAngeloGioacchino Del Regno static u16 infrasys_rst_ofs[] = { 0x30, 0x34 }; 664c02c9afSAngeloGioacchino Del Regno 674c02c9afSAngeloGioacchino Del Regno static const struct mtk_clk_rst_desc clk_rst_desc = { 684c02c9afSAngeloGioacchino Del Regno .version = MTK_RST_SIMPLE, 694c02c9afSAngeloGioacchino Del Regno .rst_bank_ofs = infrasys_rst_ofs, 704c02c9afSAngeloGioacchino Del Regno .rst_bank_nr = ARRAY_SIZE(infrasys_rst_ofs), 714c02c9afSAngeloGioacchino Del Regno }; 724c02c9afSAngeloGioacchino Del Regno 734c02c9afSAngeloGioacchino Del Regno static const struct of_device_id of_match_clk_mt8173_infracfg[] = { 744c02c9afSAngeloGioacchino Del Regno { .compatible = "mediatek,mt8173-infracfg" }, 754c02c9afSAngeloGioacchino Del Regno { /* sentinel */ } 764c02c9afSAngeloGioacchino Del Regno }; 77*65c9ad77SAngeloGioacchino Del Regno MODULE_DEVICE_TABLE(of, of_match_clk_mt8173_infracfg); 784c02c9afSAngeloGioacchino Del Regno 794c02c9afSAngeloGioacchino Del Regno static void clk_mt8173_infra_init_early(struct device_node *node) 804c02c9afSAngeloGioacchino Del Regno { 814c02c9afSAngeloGioacchino Del Regno int i; 824c02c9afSAngeloGioacchino Del Regno 834c02c9afSAngeloGioacchino Del Regno infra_clk_data = mtk_alloc_clk_data(CLK_INFRA_NR_CLK); 844c02c9afSAngeloGioacchino Del Regno if (!infra_clk_data) 854c02c9afSAngeloGioacchino Del Regno return; 864c02c9afSAngeloGioacchino Del Regno 874c02c9afSAngeloGioacchino Del Regno for (i = 0; i < CLK_INFRA_NR_CLK; i++) 884c02c9afSAngeloGioacchino Del Regno infra_clk_data->hws[i] = ERR_PTR(-EPROBE_DEFER); 894c02c9afSAngeloGioacchino Del Regno 904c02c9afSAngeloGioacchino Del Regno mtk_clk_register_factors(infra_early_divs, 914c02c9afSAngeloGioacchino Del Regno ARRAY_SIZE(infra_early_divs), infra_clk_data); 924c02c9afSAngeloGioacchino Del Regno 934c02c9afSAngeloGioacchino Del Regno of_clk_add_hw_provider(node, of_clk_hw_onecell_get, infra_clk_data); 944c02c9afSAngeloGioacchino Del Regno } 954c02c9afSAngeloGioacchino Del Regno CLK_OF_DECLARE_DRIVER(mtk_infrasys, "mediatek,mt8173-infracfg", 964c02c9afSAngeloGioacchino Del Regno clk_mt8173_infra_init_early); 974c02c9afSAngeloGioacchino Del Regno 984c02c9afSAngeloGioacchino Del Regno static int clk_mt8173_infracfg_probe(struct platform_device *pdev) 994c02c9afSAngeloGioacchino Del Regno { 1004c02c9afSAngeloGioacchino Del Regno struct device_node *node = pdev->dev.of_node; 1014c02c9afSAngeloGioacchino Del Regno int r; 1024c02c9afSAngeloGioacchino Del Regno 1034c02c9afSAngeloGioacchino Del Regno r = mtk_clk_register_gates(&pdev->dev, node, infra_gates, 1044c02c9afSAngeloGioacchino Del Regno ARRAY_SIZE(infra_gates), infra_clk_data); 1054c02c9afSAngeloGioacchino Del Regno if (r) 1064c02c9afSAngeloGioacchino Del Regno return r; 1074c02c9afSAngeloGioacchino Del Regno 1084c02c9afSAngeloGioacchino Del Regno r = mtk_clk_register_cpumuxes(&pdev->dev, node, cpu_muxes, 1094c02c9afSAngeloGioacchino Del Regno ARRAY_SIZE(cpu_muxes), infra_clk_data); 1104c02c9afSAngeloGioacchino Del Regno if (r) 1114c02c9afSAngeloGioacchino Del Regno goto unregister_gates; 1124c02c9afSAngeloGioacchino Del Regno 1134c02c9afSAngeloGioacchino Del Regno r = of_clk_add_hw_provider(node, of_clk_hw_onecell_get, infra_clk_data); 1144c02c9afSAngeloGioacchino Del Regno if (r) 1154c02c9afSAngeloGioacchino Del Regno goto unregister_cpumuxes; 1164c02c9afSAngeloGioacchino Del Regno 1174c02c9afSAngeloGioacchino Del Regno r = mtk_register_reset_controller_with_dev(&pdev->dev, &clk_rst_desc); 1184c02c9afSAngeloGioacchino Del Regno if (r) 1194c02c9afSAngeloGioacchino Del Regno goto unregister_clk_hw; 1204c02c9afSAngeloGioacchino Del Regno 1214c02c9afSAngeloGioacchino Del Regno return 0; 1224c02c9afSAngeloGioacchino Del Regno 1234c02c9afSAngeloGioacchino Del Regno unregister_clk_hw: 1244c02c9afSAngeloGioacchino Del Regno of_clk_del_provider(node); 1254c02c9afSAngeloGioacchino Del Regno unregister_cpumuxes: 1264c02c9afSAngeloGioacchino Del Regno mtk_clk_unregister_cpumuxes(cpu_muxes, ARRAY_SIZE(cpu_muxes), infra_clk_data); 1274c02c9afSAngeloGioacchino Del Regno unregister_gates: 1284c02c9afSAngeloGioacchino Del Regno mtk_clk_unregister_gates(infra_gates, ARRAY_SIZE(infra_gates), infra_clk_data); 1294c02c9afSAngeloGioacchino Del Regno return r; 1304c02c9afSAngeloGioacchino Del Regno } 1314c02c9afSAngeloGioacchino Del Regno 1324c02c9afSAngeloGioacchino Del Regno static int clk_mt8173_infracfg_remove(struct platform_device *pdev) 1334c02c9afSAngeloGioacchino Del Regno { 1344c02c9afSAngeloGioacchino Del Regno struct device_node *node = pdev->dev.of_node; 1354c02c9afSAngeloGioacchino Del Regno struct clk_hw_onecell_data *clk_data = platform_get_drvdata(pdev); 1364c02c9afSAngeloGioacchino Del Regno 1374c02c9afSAngeloGioacchino Del Regno of_clk_del_provider(node); 1384c02c9afSAngeloGioacchino Del Regno mtk_clk_unregister_cpumuxes(cpu_muxes, ARRAY_SIZE(cpu_muxes), clk_data); 1394c02c9afSAngeloGioacchino Del Regno mtk_clk_unregister_gates(infra_gates, ARRAY_SIZE(infra_gates), clk_data); 1404c02c9afSAngeloGioacchino Del Regno mtk_free_clk_data(clk_data); 1414c02c9afSAngeloGioacchino Del Regno 1424c02c9afSAngeloGioacchino Del Regno return 0; 1434c02c9afSAngeloGioacchino Del Regno } 1444c02c9afSAngeloGioacchino Del Regno 1454c02c9afSAngeloGioacchino Del Regno static struct platform_driver clk_mt8173_infracfg_drv = { 1464c02c9afSAngeloGioacchino Del Regno .driver = { 1474c02c9afSAngeloGioacchino Del Regno .name = "clk-mt8173-infracfg", 1484c02c9afSAngeloGioacchino Del Regno .of_match_table = of_match_clk_mt8173_infracfg, 1494c02c9afSAngeloGioacchino Del Regno }, 1504c02c9afSAngeloGioacchino Del Regno .probe = clk_mt8173_infracfg_probe, 1514c02c9afSAngeloGioacchino Del Regno .remove = clk_mt8173_infracfg_remove, 1524c02c9afSAngeloGioacchino Del Regno }; 1534c02c9afSAngeloGioacchino Del Regno module_platform_driver(clk_mt8173_infracfg_drv); 1544c02c9afSAngeloGioacchino Del Regno 1554c02c9afSAngeloGioacchino Del Regno MODULE_DESCRIPTION("MediaTek MT8173 infracfg clocks driver"); 1564c02c9afSAngeloGioacchino Del Regno MODULE_LICENSE("GPL"); 157