162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright (c) 2022 Collabora Ltd.
462306a36Sopenharmony_ci * Author: AngeloGioacchino Del Regno <angelogioacchino.delregno@collabora.com>
562306a36Sopenharmony_ci */
662306a36Sopenharmony_ci
762306a36Sopenharmony_ci#include <dt-bindings/clock/mediatek,mt6795-clk.h>
862306a36Sopenharmony_ci#include <dt-bindings/reset/mediatek,mt6795-resets.h>
962306a36Sopenharmony_ci#include <linux/module.h>
1062306a36Sopenharmony_ci#include <linux/platform_device.h>
1162306a36Sopenharmony_ci#include "clk-gate.h"
1262306a36Sopenharmony_ci#include "clk-mtk.h"
1362306a36Sopenharmony_ci#include "reset.h"
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_ci#define GATE_PERI(_id, _name, _parent, _shift)			\
1662306a36Sopenharmony_ci		GATE_MTK(_id, _name, _parent, &peri_cg_regs,	\
1762306a36Sopenharmony_ci			 _shift, &mtk_clk_gate_ops_setclr)
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_cistatic DEFINE_SPINLOCK(mt6795_peri_clk_lock);
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_cistatic const struct mtk_gate_regs peri_cg_regs = {
2262306a36Sopenharmony_ci	.set_ofs = 0x0008,
2362306a36Sopenharmony_ci	.clr_ofs = 0x0010,
2462306a36Sopenharmony_ci	.sta_ofs = 0x0018,
2562306a36Sopenharmony_ci};
2662306a36Sopenharmony_ci
2762306a36Sopenharmony_cistatic const char * const uart_ck_sel_parents[] = {
2862306a36Sopenharmony_ci	"clk26m",
2962306a36Sopenharmony_ci	"uart_sel",
3062306a36Sopenharmony_ci};
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_cistatic const struct mtk_composite peri_clks[] = {
3362306a36Sopenharmony_ci	MUX(CLK_PERI_UART0_SEL, "uart0_ck_sel", uart_ck_sel_parents, 0x40c, 0, 1),
3462306a36Sopenharmony_ci	MUX(CLK_PERI_UART1_SEL, "uart1_ck_sel", uart_ck_sel_parents, 0x40c, 1, 1),
3562306a36Sopenharmony_ci	MUX(CLK_PERI_UART2_SEL, "uart2_ck_sel", uart_ck_sel_parents, 0x40c, 2, 1),
3662306a36Sopenharmony_ci	MUX(CLK_PERI_UART3_SEL, "uart3_ck_sel", uart_ck_sel_parents, 0x40c, 3, 1),
3762306a36Sopenharmony_ci};
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_cistatic const struct mtk_gate peri_gates[] = {
4062306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_NFI, "peri_nfi", "axi_sel", 0),
4162306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_THERM, "peri_therm", "axi_sel", 1),
4262306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_PWM1, "peri_pwm1", "axi_sel", 2),
4362306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_PWM2, "peri_pwm2", "axi_sel", 3),
4462306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_PWM3, "peri_pwm3", "axi_sel", 4),
4562306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_PWM4, "peri_pwm4", "axi_sel", 5),
4662306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_PWM5, "peri_pwm5", "axi_sel", 6),
4762306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_PWM6, "peri_pwm6", "axi_sel", 7),
4862306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_PWM7, "peri_pwm7", "axi_sel", 8),
4962306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_PWM, "peri_pwm", "axi_sel", 9),
5062306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_USB0, "peri_usb0", "usb30_sel", 10),
5162306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_USB1, "peri_usb1", "usb20_sel", 11),
5262306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_AP_DMA, "peri_ap_dma", "axi_sel", 12),
5362306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_MSDC30_0, "peri_msdc30_0", "msdc50_0_sel", 13),
5462306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_MSDC30_1, "peri_msdc30_1", "msdc30_1_sel", 14),
5562306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_MSDC30_2, "peri_msdc30_2", "msdc30_2_sel", 15),
5662306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_MSDC30_3, "peri_msdc30_3", "msdc30_3_sel", 16),
5762306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_NLI_ARB, "peri_nli_arb", "axi_sel", 17),
5862306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_IRDA, "peri_irda", "irda_sel", 18),
5962306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_UART0, "peri_uart0", "axi_sel", 19),
6062306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_UART1, "peri_uart1", "axi_sel", 20),
6162306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_UART2, "peri_uart2", "axi_sel", 21),
6262306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_UART3, "peri_uart3", "axi_sel", 22),
6362306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_I2C0, "peri_i2c0", "axi_sel", 23),
6462306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_I2C1, "peri_i2c1", "axi_sel", 24),
6562306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_I2C2, "peri_i2c2", "axi_sel", 25),
6662306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_I2C3, "peri_i2c3", "axi_sel", 26),
6762306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_I2C4, "peri_i2c4", "axi_sel", 27),
6862306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_AUXADC, "peri_auxadc", "clk26m", 28),
6962306a36Sopenharmony_ci	GATE_PERI(CLK_PERI_SPI0, "peri_spi0", "spi_sel", 29),
7062306a36Sopenharmony_ci};
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_cistatic u16 peri_rst_ofs[] = { 0x0 };
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_cistatic u16 peri_idx_map[] = {
7562306a36Sopenharmony_ci	[MT6795_PERI_NFI_SW_RST]   = 14,
7662306a36Sopenharmony_ci	[MT6795_PERI_THERM_SW_RST] = 16,
7762306a36Sopenharmony_ci	[MT6795_PERI_MSDC1_SW_RST] = 20,
7862306a36Sopenharmony_ci};
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_cistatic const struct mtk_clk_rst_desc clk_rst_desc = {
8162306a36Sopenharmony_ci	.version = MTK_RST_SIMPLE,
8262306a36Sopenharmony_ci	.rst_bank_ofs = peri_rst_ofs,
8362306a36Sopenharmony_ci	.rst_bank_nr = ARRAY_SIZE(peri_rst_ofs),
8462306a36Sopenharmony_ci	.rst_idx_map = peri_idx_map,
8562306a36Sopenharmony_ci	.rst_idx_map_nr = ARRAY_SIZE(peri_idx_map),
8662306a36Sopenharmony_ci};
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_cistatic const struct of_device_id of_match_clk_mt6795_pericfg[] = {
8962306a36Sopenharmony_ci	{ .compatible = "mediatek,mt6795-pericfg" },
9062306a36Sopenharmony_ci	{ /* sentinel */ }
9162306a36Sopenharmony_ci};
9262306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, of_match_clk_mt6795_pericfg);
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_cistatic int clk_mt6795_pericfg_probe(struct platform_device *pdev)
9562306a36Sopenharmony_ci{
9662306a36Sopenharmony_ci	struct clk_hw_onecell_data *clk_data;
9762306a36Sopenharmony_ci	struct device_node *node = pdev->dev.of_node;
9862306a36Sopenharmony_ci	void __iomem *base;
9962306a36Sopenharmony_ci	int ret;
10062306a36Sopenharmony_ci
10162306a36Sopenharmony_ci	base = devm_platform_ioremap_resource(pdev, 0);
10262306a36Sopenharmony_ci	if (IS_ERR(base))
10362306a36Sopenharmony_ci		return PTR_ERR(base);
10462306a36Sopenharmony_ci
10562306a36Sopenharmony_ci	clk_data = mtk_alloc_clk_data(CLK_PERI_NR_CLK);
10662306a36Sopenharmony_ci	if (!clk_data)
10762306a36Sopenharmony_ci		return -ENOMEM;
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	ret = mtk_register_reset_controller_with_dev(&pdev->dev, &clk_rst_desc);
11062306a36Sopenharmony_ci	if (ret)
11162306a36Sopenharmony_ci		goto free_clk_data;
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_ci	ret = mtk_clk_register_gates(&pdev->dev, node, peri_gates,
11462306a36Sopenharmony_ci				     ARRAY_SIZE(peri_gates), clk_data);
11562306a36Sopenharmony_ci	if (ret)
11662306a36Sopenharmony_ci		goto free_clk_data;
11762306a36Sopenharmony_ci
11862306a36Sopenharmony_ci	ret = mtk_clk_register_composites(&pdev->dev, peri_clks,
11962306a36Sopenharmony_ci					  ARRAY_SIZE(peri_clks), base,
12062306a36Sopenharmony_ci					  &mt6795_peri_clk_lock, clk_data);
12162306a36Sopenharmony_ci	if (ret)
12262306a36Sopenharmony_ci		goto unregister_gates;
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_ci	ret = of_clk_add_hw_provider(node, of_clk_hw_onecell_get, clk_data);
12562306a36Sopenharmony_ci	if (ret)
12662306a36Sopenharmony_ci		goto unregister_composites;
12762306a36Sopenharmony_ci
12862306a36Sopenharmony_ci	return 0;
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_ciunregister_composites:
13162306a36Sopenharmony_ci	mtk_clk_unregister_composites(peri_clks, ARRAY_SIZE(peri_clks), clk_data);
13262306a36Sopenharmony_ciunregister_gates:
13362306a36Sopenharmony_ci	mtk_clk_unregister_gates(peri_gates, ARRAY_SIZE(peri_gates), clk_data);
13462306a36Sopenharmony_cifree_clk_data:
13562306a36Sopenharmony_ci	mtk_free_clk_data(clk_data);
13662306a36Sopenharmony_ci	return ret;
13762306a36Sopenharmony_ci}
13862306a36Sopenharmony_ci
13962306a36Sopenharmony_cistatic void clk_mt6795_pericfg_remove(struct platform_device *pdev)
14062306a36Sopenharmony_ci{
14162306a36Sopenharmony_ci	struct device_node *node = pdev->dev.of_node;
14262306a36Sopenharmony_ci	struct clk_hw_onecell_data *clk_data = platform_get_drvdata(pdev);
14362306a36Sopenharmony_ci
14462306a36Sopenharmony_ci	of_clk_del_provider(node);
14562306a36Sopenharmony_ci	mtk_clk_unregister_composites(peri_clks, ARRAY_SIZE(peri_clks), clk_data);
14662306a36Sopenharmony_ci	mtk_clk_unregister_gates(peri_gates, ARRAY_SIZE(peri_gates), clk_data);
14762306a36Sopenharmony_ci	mtk_free_clk_data(clk_data);
14862306a36Sopenharmony_ci}
14962306a36Sopenharmony_ci
15062306a36Sopenharmony_cistatic struct platform_driver clk_mt6795_pericfg_drv = {
15162306a36Sopenharmony_ci	.driver = {
15262306a36Sopenharmony_ci		.name = "clk-mt6795-pericfg",
15362306a36Sopenharmony_ci		.of_match_table = of_match_clk_mt6795_pericfg,
15462306a36Sopenharmony_ci	},
15562306a36Sopenharmony_ci	.probe = clk_mt6795_pericfg_probe,
15662306a36Sopenharmony_ci	.remove_new = clk_mt6795_pericfg_remove,
15762306a36Sopenharmony_ci};
15862306a36Sopenharmony_cimodule_platform_driver(clk_mt6795_pericfg_drv);
15962306a36Sopenharmony_ci
16062306a36Sopenharmony_ciMODULE_DESCRIPTION("MediaTek MT6795 pericfg clocks driver");
16162306a36Sopenharmony_ciMODULE_LICENSE("GPL");
162