/* SPDX-License-Identifier: GPL-2.0 */ /* * Copyright (c) 2019 MediaTek Inc. */ #include #include #include #include "clk-mtk.h" #include "clk-gate.h" #include #define MT_CCF_BRINGUP 1 /* Regular Number Definition */ #define INV_OFS -1 #define INV_BIT -1 static const struct mtk_gate_regs msdc0_cg_regs = { .set_ofs = 0x68, .clr_ofs = 0x68, .sta_ofs = 0x68, }; #define GATE_MSDC0(_id, _name, _parent, _shift) { \ .id = _id, \ .name = _name, \ .parent_name = _parent, \ .regs = &msdc0_cg_regs, \ .shift = _shift, \ .ops = &mtk_clk_gate_ops_no_setclr_inv, \ } static const struct mtk_gate msdc0_clks[] = { GATE_MSDC0(CLK_MSDC0_MSDC_NEW_RX_PATH_SEL, "msdc0_msdc_rx", "msdc_new_rx_ck"/* parent */, 0), }; static int clk_mt6877_msdc0_probe(struct platform_device *pdev) { struct clk_onecell_data *clk_data; int r; struct device_node *node = pdev->dev.of_node; #if MT_CCF_BRINGUP pr_notice("%s init begin\n", __func__); #endif clk_data = mtk_alloc_clk_data(CLK_MSDC0_NR_CLK); mtk_clk_register_gates(node, msdc0_clks, ARRAY_SIZE(msdc0_clks), clk_data); r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data); if (r) pr_err("%s(): could not register clock provider: %d\n", __func__, r); #if MT_CCF_BRINGUP pr_notice("%s init end\n", __func__); #endif return r; } static const struct of_device_id of_match_clk_mt6877_msdc[] = { { .compatible = "mediatek,mt6877-msdc0sys", .data = clk_mt6877_msdc0_probe, }, { /* sentinel */ } }; static int clk_mt6877_msdc_probe(struct platform_device *pdev) { int (*clk_probe)(struct platform_device *pd); int r; clk_probe = of_device_get_match_data(&pdev->dev); if (!clk_probe) return -EINVAL; r = clk_probe(pdev); if (r) dev_err(&pdev->dev, "could not register clock provider: %s: %d\n", pdev->name, r); return r; } static struct platform_driver clk_mt6877_msdc_drv = { .probe = clk_mt6877_msdc_probe, .driver = { .name = "clk-mt6877-msdc", .of_match_table = of_match_clk_mt6877_msdc, }, }; static int __init clk_mt6877_msdc_init(void) { return platform_driver_register(&clk_mt6877_msdc_drv); } arch_initcall(clk_mt6877_msdc_init);