18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Copyright (c) 2017 MediaTek Inc.
48c2ecf20Sopenharmony_ci * Author: Weiyi Lu <weiyi.lu@mediatek.com>
58c2ecf20Sopenharmony_ci */
68c2ecf20Sopenharmony_ci
78c2ecf20Sopenharmony_ci#include <linux/clk-provider.h>
88c2ecf20Sopenharmony_ci#include <linux/platform_device.h>
98c2ecf20Sopenharmony_ci
108c2ecf20Sopenharmony_ci#include "clk-mtk.h"
118c2ecf20Sopenharmony_ci#include "clk-gate.h"
128c2ecf20Sopenharmony_ci
138c2ecf20Sopenharmony_ci#include <dt-bindings/clock/mt2712-clk.h>
148c2ecf20Sopenharmony_ci
158c2ecf20Sopenharmony_cistatic const struct mtk_gate_regs mm0_cg_regs = {
168c2ecf20Sopenharmony_ci	.set_ofs = 0x104,
178c2ecf20Sopenharmony_ci	.clr_ofs = 0x108,
188c2ecf20Sopenharmony_ci	.sta_ofs = 0x100,
198c2ecf20Sopenharmony_ci};
208c2ecf20Sopenharmony_ci
218c2ecf20Sopenharmony_cistatic const struct mtk_gate_regs mm1_cg_regs = {
228c2ecf20Sopenharmony_ci	.set_ofs = 0x114,
238c2ecf20Sopenharmony_ci	.clr_ofs = 0x118,
248c2ecf20Sopenharmony_ci	.sta_ofs = 0x110,
258c2ecf20Sopenharmony_ci};
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_cistatic const struct mtk_gate_regs mm2_cg_regs = {
288c2ecf20Sopenharmony_ci	.set_ofs = 0x224,
298c2ecf20Sopenharmony_ci	.clr_ofs = 0x228,
308c2ecf20Sopenharmony_ci	.sta_ofs = 0x220,
318c2ecf20Sopenharmony_ci};
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_ci#define GATE_MM0(_id, _name, _parent, _shift) {	\
348c2ecf20Sopenharmony_ci		.id = _id,				\
358c2ecf20Sopenharmony_ci		.name = _name,				\
368c2ecf20Sopenharmony_ci		.parent_name = _parent,			\
378c2ecf20Sopenharmony_ci		.regs = &mm0_cg_regs,			\
388c2ecf20Sopenharmony_ci		.shift = _shift,			\
398c2ecf20Sopenharmony_ci		.ops = &mtk_clk_gate_ops_setclr,	\
408c2ecf20Sopenharmony_ci	}
418c2ecf20Sopenharmony_ci
428c2ecf20Sopenharmony_ci#define GATE_MM1(_id, _name, _parent, _shift) {	\
438c2ecf20Sopenharmony_ci		.id = _id,				\
448c2ecf20Sopenharmony_ci		.name = _name,				\
458c2ecf20Sopenharmony_ci		.parent_name = _parent,			\
468c2ecf20Sopenharmony_ci		.regs = &mm1_cg_regs,			\
478c2ecf20Sopenharmony_ci		.shift = _shift,			\
488c2ecf20Sopenharmony_ci		.ops = &mtk_clk_gate_ops_setclr,	\
498c2ecf20Sopenharmony_ci	}
508c2ecf20Sopenharmony_ci
518c2ecf20Sopenharmony_ci#define GATE_MM2(_id, _name, _parent, _shift) {	\
528c2ecf20Sopenharmony_ci		.id = _id,				\
538c2ecf20Sopenharmony_ci		.name = _name,				\
548c2ecf20Sopenharmony_ci		.parent_name = _parent,			\
558c2ecf20Sopenharmony_ci		.regs = &mm2_cg_regs,			\
568c2ecf20Sopenharmony_ci		.shift = _shift,			\
578c2ecf20Sopenharmony_ci		.ops = &mtk_clk_gate_ops_setclr,	\
588c2ecf20Sopenharmony_ci	}
598c2ecf20Sopenharmony_ci
608c2ecf20Sopenharmony_cistatic const struct mtk_gate mm_clks[] = {
618c2ecf20Sopenharmony_ci	/* MM0 */
628c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_SMI_COMMON, "mm_smi_common", "mm_sel", 0),
638c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_SMI_LARB0, "mm_smi_larb0", "mm_sel", 1),
648c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_CAM_MDP, "mm_cam_mdp", "mm_sel", 2),
658c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_MDP_RDMA0, "mm_mdp_rdma0", "mm_sel", 3),
668c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_MDP_RDMA1, "mm_mdp_rdma1", "mm_sel", 4),
678c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_MDP_RSZ0, "mm_mdp_rsz0", "mm_sel", 5),
688c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_MDP_RSZ1, "mm_mdp_rsz1", "mm_sel", 6),
698c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_MDP_RSZ2, "mm_mdp_rsz2", "mm_sel", 7),
708c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_MDP_TDSHP0, "mm_mdp_tdshp0", "mm_sel", 8),
718c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_MDP_TDSHP1, "mm_mdp_tdshp1", "mm_sel", 9),
728c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_MDP_CROP, "mm_mdp_crop", "mm_sel", 10),
738c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_MDP_WDMA, "mm_mdp_wdma", "mm_sel", 11),
748c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_MDP_WROT0, "mm_mdp_wrot0", "mm_sel", 12),
758c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_MDP_WROT1, "mm_mdp_wrot1", "mm_sel", 13),
768c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_FAKE_ENG, "mm_fake_eng", "mm_sel", 14),
778c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_MUTEX_32K, "mm_mutex_32k", "clk32k", 15),
788c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_OVL0, "mm_disp_ovl0", "mm_sel", 16),
798c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_OVL1, "mm_disp_ovl1", "mm_sel", 17),
808c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_RDMA0, "mm_disp_rdma0", "mm_sel", 18),
818c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_RDMA1, "mm_disp_rdma1", "mm_sel", 19),
828c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_RDMA2, "mm_disp_rdma2", "mm_sel", 20),
838c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_WDMA0, "mm_disp_wdma0", "mm_sel", 21),
848c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_WDMA1, "mm_disp_wdma1", "mm_sel", 22),
858c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_COLOR0, "mm_disp_color0", "mm_sel", 23),
868c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_COLOR1, "mm_disp_color1", "mm_sel", 24),
878c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_AAL, "mm_disp_aal", "mm_sel", 25),
888c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_GAMMA, "mm_disp_gamma", "mm_sel", 26),
898c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_UFOE, "mm_disp_ufoe", "mm_sel", 27),
908c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_SPLIT0, "mm_disp_split0", "mm_sel", 28),
918c2ecf20Sopenharmony_ci	GATE_MM0(CLK_MM_DISP_OD, "mm_disp_od", "mm_sel", 31),
928c2ecf20Sopenharmony_ci	/* MM1 */
938c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DISP_PWM0_MM, "mm_pwm0_mm", "mm_sel", 0),
948c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DISP_PWM0_26M, "mm_pwm0_26m", "pwm_sel", 1),
958c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DISP_PWM1_MM, "mm_pwm1_mm", "mm_sel", 2),
968c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DISP_PWM1_26M, "mm_pwm1_26m", "pwm_sel", 3),
978c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DSI0_ENGINE, "mm_dsi0_engine", "mm_sel", 4),
988c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DSI0_DIGITAL, "mm_dsi0_digital", "dsi0_lntc", 5),
998c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DSI1_ENGINE, "mm_dsi1_engine", "mm_sel", 6),
1008c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DSI1_DIGITAL, "mm_dsi1_digital", "dsi1_lntc", 7),
1018c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DPI_PIXEL, "mm_dpi_pixel", "vpll_dpix", 8),
1028c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DPI_ENGINE, "mm_dpi_engine", "mm_sel", 9),
1038c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DPI1_PIXEL, "mm_dpi1_pixel", "vpll3_dpix", 10),
1048c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DPI1_ENGINE, "mm_dpi1_engine", "mm_sel", 11),
1058c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_LVDS_PIXEL, "mm_lvds_pixel", "vpll_dpix", 16),
1068c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_LVDS_CTS, "mm_lvds_cts", "lvdstx", 17),
1078c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_SMI_LARB4, "mm_smi_larb4", "mm_sel", 18),
1088c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_SMI_COMMON1, "mm_smi_common1", "mm_sel", 21),
1098c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_SMI_LARB5, "mm_smi_larb5", "mm_sel", 22),
1108c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_MDP_RDMA2, "mm_mdp_rdma2", "mm_sel", 23),
1118c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_MDP_TDSHP2, "mm_mdp_tdshp2", "mm_sel", 24),
1128c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DISP_OVL2, "mm_disp_ovl2", "mm_sel", 25),
1138c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DISP_WDMA2, "mm_disp_wdma2", "mm_sel", 26),
1148c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DISP_COLOR2, "mm_disp_color2", "mm_sel", 27),
1158c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DISP_AAL1, "mm_disp_aal1", "mm_sel", 28),
1168c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_DISP_OD1, "mm_disp_od1", "mm_sel", 29),
1178c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_LVDS1_PIXEL, "mm_lvds1_pixel", "vpll3_dpix", 30),
1188c2ecf20Sopenharmony_ci	GATE_MM1(CLK_MM_LVDS1_CTS, "mm_lvds1_cts", "lvdstx3", 31),
1198c2ecf20Sopenharmony_ci	/* MM2 */
1208c2ecf20Sopenharmony_ci	GATE_MM2(CLK_MM_SMI_LARB7, "mm_smi_larb7", "mm_sel", 0),
1218c2ecf20Sopenharmony_ci	GATE_MM2(CLK_MM_MDP_RDMA3, "mm_mdp_rdma3", "mm_sel", 1),
1228c2ecf20Sopenharmony_ci	GATE_MM2(CLK_MM_MDP_WROT2, "mm_mdp_wrot2", "mm_sel", 2),
1238c2ecf20Sopenharmony_ci	GATE_MM2(CLK_MM_DSI2, "mm_dsi2", "mm_sel", 3),
1248c2ecf20Sopenharmony_ci	GATE_MM2(CLK_MM_DSI2_DIGITAL, "mm_dsi2_digital", "dsi0_lntc", 4),
1258c2ecf20Sopenharmony_ci	GATE_MM2(CLK_MM_DSI3, "mm_dsi3", "mm_sel", 5),
1268c2ecf20Sopenharmony_ci	GATE_MM2(CLK_MM_DSI3_DIGITAL, "mm_dsi3_digital", "dsi1_lntc", 6),
1278c2ecf20Sopenharmony_ci};
1288c2ecf20Sopenharmony_ci
1298c2ecf20Sopenharmony_cistatic int clk_mt2712_mm_probe(struct platform_device *pdev)
1308c2ecf20Sopenharmony_ci{
1318c2ecf20Sopenharmony_ci	struct device *dev = &pdev->dev;
1328c2ecf20Sopenharmony_ci	struct device_node *node = dev->parent->of_node;
1338c2ecf20Sopenharmony_ci	struct clk_onecell_data *clk_data;
1348c2ecf20Sopenharmony_ci	int r;
1358c2ecf20Sopenharmony_ci
1368c2ecf20Sopenharmony_ci	clk_data = mtk_alloc_clk_data(CLK_MM_NR_CLK);
1378c2ecf20Sopenharmony_ci
1388c2ecf20Sopenharmony_ci	mtk_clk_register_gates(node, mm_clks, ARRAY_SIZE(mm_clks),
1398c2ecf20Sopenharmony_ci			clk_data);
1408c2ecf20Sopenharmony_ci
1418c2ecf20Sopenharmony_ci	r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data);
1428c2ecf20Sopenharmony_ci
1438c2ecf20Sopenharmony_ci	if (r != 0)
1448c2ecf20Sopenharmony_ci		pr_err("%s(): could not register clock provider: %d\n",
1458c2ecf20Sopenharmony_ci			__func__, r);
1468c2ecf20Sopenharmony_ci
1478c2ecf20Sopenharmony_ci	return r;
1488c2ecf20Sopenharmony_ci}
1498c2ecf20Sopenharmony_ci
1508c2ecf20Sopenharmony_cistatic struct platform_driver clk_mt2712_mm_drv = {
1518c2ecf20Sopenharmony_ci	.probe = clk_mt2712_mm_probe,
1528c2ecf20Sopenharmony_ci	.driver = {
1538c2ecf20Sopenharmony_ci		.name = "clk-mt2712-mm",
1548c2ecf20Sopenharmony_ci	},
1558c2ecf20Sopenharmony_ci};
1568c2ecf20Sopenharmony_ci
1578c2ecf20Sopenharmony_cibuiltin_platform_driver(clk_mt2712_mm_drv);
158