18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Copyright (c) 2018, The Linux Foundation. All rights reserved.
48c2ecf20Sopenharmony_ci */
58c2ecf20Sopenharmony_ci
68c2ecf20Sopenharmony_ci#include <linux/bitops.h>
78c2ecf20Sopenharmony_ci#include <linux/err.h>
88c2ecf20Sopenharmony_ci#include <linux/module.h>
98c2ecf20Sopenharmony_ci#include <linux/platform_device.h>
108c2ecf20Sopenharmony_ci#include <linux/pm_clock.h>
118c2ecf20Sopenharmony_ci#include <linux/pm_runtime.h>
128c2ecf20Sopenharmony_ci#include <linux/regmap.h>
138c2ecf20Sopenharmony_ci
148c2ecf20Sopenharmony_ci#include <dt-bindings/clock/qcom,q6sstopcc-qcs404.h>
158c2ecf20Sopenharmony_ci
168c2ecf20Sopenharmony_ci#include "clk-regmap.h"
178c2ecf20Sopenharmony_ci#include "clk-branch.h"
188c2ecf20Sopenharmony_ci#include "common.h"
198c2ecf20Sopenharmony_ci#include "reset.h"
208c2ecf20Sopenharmony_ci
218c2ecf20Sopenharmony_cistatic struct clk_branch lcc_ahbfabric_cbc_clk = {
228c2ecf20Sopenharmony_ci	.halt_reg = 0x1b004,
238c2ecf20Sopenharmony_ci	.halt_check = BRANCH_HALT,
248c2ecf20Sopenharmony_ci	.clkr = {
258c2ecf20Sopenharmony_ci		.enable_reg = 0x1b004,
268c2ecf20Sopenharmony_ci		.enable_mask = BIT(0),
278c2ecf20Sopenharmony_ci		.hw.init = &(struct clk_init_data){
288c2ecf20Sopenharmony_ci			.name = "lcc_ahbfabric_cbc_clk",
298c2ecf20Sopenharmony_ci			.ops = &clk_branch2_ops,
308c2ecf20Sopenharmony_ci		},
318c2ecf20Sopenharmony_ci	},
328c2ecf20Sopenharmony_ci};
338c2ecf20Sopenharmony_ci
348c2ecf20Sopenharmony_cistatic struct clk_branch lcc_q6ss_ahbs_cbc_clk = {
358c2ecf20Sopenharmony_ci	.halt_reg = 0x22000,
368c2ecf20Sopenharmony_ci	.halt_check = BRANCH_VOTED,
378c2ecf20Sopenharmony_ci	.clkr = {
388c2ecf20Sopenharmony_ci		.enable_reg = 0x22000,
398c2ecf20Sopenharmony_ci		.enable_mask = BIT(0),
408c2ecf20Sopenharmony_ci		.hw.init = &(struct clk_init_data){
418c2ecf20Sopenharmony_ci			.name = "lcc_q6ss_ahbs_cbc_clk",
428c2ecf20Sopenharmony_ci			.ops = &clk_branch2_ops,
438c2ecf20Sopenharmony_ci		},
448c2ecf20Sopenharmony_ci	},
458c2ecf20Sopenharmony_ci};
468c2ecf20Sopenharmony_ci
478c2ecf20Sopenharmony_cistatic struct clk_branch lcc_q6ss_tcm_slave_cbc_clk = {
488c2ecf20Sopenharmony_ci	.halt_reg = 0x1c000,
498c2ecf20Sopenharmony_ci	.halt_check = BRANCH_VOTED,
508c2ecf20Sopenharmony_ci	.clkr = {
518c2ecf20Sopenharmony_ci		.enable_reg = 0x1c000,
528c2ecf20Sopenharmony_ci		.enable_mask = BIT(0),
538c2ecf20Sopenharmony_ci		.hw.init = &(struct clk_init_data){
548c2ecf20Sopenharmony_ci			.name = "lcc_q6ss_tcm_slave_cbc_clk",
558c2ecf20Sopenharmony_ci			.ops = &clk_branch2_ops,
568c2ecf20Sopenharmony_ci		},
578c2ecf20Sopenharmony_ci	},
588c2ecf20Sopenharmony_ci};
598c2ecf20Sopenharmony_ci
608c2ecf20Sopenharmony_cistatic struct clk_branch lcc_q6ss_ahbm_cbc_clk = {
618c2ecf20Sopenharmony_ci	.halt_reg = 0x22004,
628c2ecf20Sopenharmony_ci	.halt_check = BRANCH_VOTED,
638c2ecf20Sopenharmony_ci	.clkr = {
648c2ecf20Sopenharmony_ci		.enable_reg = 0x22004,
658c2ecf20Sopenharmony_ci		.enable_mask = BIT(0),
668c2ecf20Sopenharmony_ci		.hw.init = &(struct clk_init_data){
678c2ecf20Sopenharmony_ci			.name = "lcc_q6ss_ahbm_cbc_clk",
688c2ecf20Sopenharmony_ci			.ops = &clk_branch2_ops,
698c2ecf20Sopenharmony_ci		},
708c2ecf20Sopenharmony_ci	},
718c2ecf20Sopenharmony_ci};
728c2ecf20Sopenharmony_ci
738c2ecf20Sopenharmony_cistatic struct clk_branch lcc_q6ss_axim_cbc_clk = {
748c2ecf20Sopenharmony_ci	.halt_reg = 0x1c004,
758c2ecf20Sopenharmony_ci	.halt_check = BRANCH_VOTED,
768c2ecf20Sopenharmony_ci	.clkr = {
778c2ecf20Sopenharmony_ci		.enable_reg = 0x1c004,
788c2ecf20Sopenharmony_ci		.enable_mask = BIT(0),
798c2ecf20Sopenharmony_ci		.hw.init = &(struct clk_init_data){
808c2ecf20Sopenharmony_ci			.name = "lcc_q6ss_axim_cbc_clk",
818c2ecf20Sopenharmony_ci			.ops = &clk_branch2_ops,
828c2ecf20Sopenharmony_ci		},
838c2ecf20Sopenharmony_ci	},
848c2ecf20Sopenharmony_ci};
858c2ecf20Sopenharmony_ci
868c2ecf20Sopenharmony_cistatic struct clk_branch lcc_q6ss_bcr_sleep_clk = {
878c2ecf20Sopenharmony_ci	.halt_reg = 0x6004,
888c2ecf20Sopenharmony_ci	.halt_check = BRANCH_VOTED,
898c2ecf20Sopenharmony_ci	.clkr = {
908c2ecf20Sopenharmony_ci		.enable_reg = 0x6004,
918c2ecf20Sopenharmony_ci		.enable_mask = BIT(0),
928c2ecf20Sopenharmony_ci		.hw.init = &(struct clk_init_data){
938c2ecf20Sopenharmony_ci			.name = "lcc_q6ss_bcr_sleep_clk",
948c2ecf20Sopenharmony_ci			.ops = &clk_branch2_ops,
958c2ecf20Sopenharmony_ci		},
968c2ecf20Sopenharmony_ci	},
978c2ecf20Sopenharmony_ci};
988c2ecf20Sopenharmony_ci
998c2ecf20Sopenharmony_ci/* TCSR clock */
1008c2ecf20Sopenharmony_cistatic struct clk_branch tcsr_lcc_csr_cbcr_clk = {
1018c2ecf20Sopenharmony_ci	.halt_reg = 0x8008,
1028c2ecf20Sopenharmony_ci	.halt_check = BRANCH_VOTED,
1038c2ecf20Sopenharmony_ci	.clkr = {
1048c2ecf20Sopenharmony_ci		.enable_reg = 0x8008,
1058c2ecf20Sopenharmony_ci		.enable_mask = BIT(0),
1068c2ecf20Sopenharmony_ci		.hw.init = &(struct clk_init_data){
1078c2ecf20Sopenharmony_ci			.name = "tcsr_lcc_csr_cbcr_clk",
1088c2ecf20Sopenharmony_ci			.ops = &clk_branch2_ops,
1098c2ecf20Sopenharmony_ci		},
1108c2ecf20Sopenharmony_ci	},
1118c2ecf20Sopenharmony_ci};
1128c2ecf20Sopenharmony_ci
1138c2ecf20Sopenharmony_cistatic struct regmap_config q6sstop_regmap_config = {
1148c2ecf20Sopenharmony_ci	.reg_bits	= 32,
1158c2ecf20Sopenharmony_ci	.reg_stride	= 4,
1168c2ecf20Sopenharmony_ci	.val_bits	= 32,
1178c2ecf20Sopenharmony_ci	.fast_io	= true,
1188c2ecf20Sopenharmony_ci};
1198c2ecf20Sopenharmony_ci
1208c2ecf20Sopenharmony_cistatic struct clk_regmap *q6sstop_qcs404_clocks[] = {
1218c2ecf20Sopenharmony_ci	[LCC_AHBFABRIC_CBC_CLK] = &lcc_ahbfabric_cbc_clk.clkr,
1228c2ecf20Sopenharmony_ci	[LCC_Q6SS_AHBS_CBC_CLK] = &lcc_q6ss_ahbs_cbc_clk.clkr,
1238c2ecf20Sopenharmony_ci	[LCC_Q6SS_TCM_SLAVE_CBC_CLK] = &lcc_q6ss_tcm_slave_cbc_clk.clkr,
1248c2ecf20Sopenharmony_ci	[LCC_Q6SS_AHBM_CBC_CLK] = &lcc_q6ss_ahbm_cbc_clk.clkr,
1258c2ecf20Sopenharmony_ci	[LCC_Q6SS_AXIM_CBC_CLK] = &lcc_q6ss_axim_cbc_clk.clkr,
1268c2ecf20Sopenharmony_ci	[LCC_Q6SS_BCR_SLEEP_CLK] = &lcc_q6ss_bcr_sleep_clk.clkr,
1278c2ecf20Sopenharmony_ci};
1288c2ecf20Sopenharmony_ci
1298c2ecf20Sopenharmony_cistatic const struct qcom_reset_map q6sstop_qcs404_resets[] = {
1308c2ecf20Sopenharmony_ci	[Q6SSTOP_BCR_RESET] = { 0x6000 },
1318c2ecf20Sopenharmony_ci};
1328c2ecf20Sopenharmony_ci
1338c2ecf20Sopenharmony_cistatic const struct qcom_cc_desc q6sstop_qcs404_desc = {
1348c2ecf20Sopenharmony_ci	.config = &q6sstop_regmap_config,
1358c2ecf20Sopenharmony_ci	.clks = q6sstop_qcs404_clocks,
1368c2ecf20Sopenharmony_ci	.num_clks = ARRAY_SIZE(q6sstop_qcs404_clocks),
1378c2ecf20Sopenharmony_ci	.resets = q6sstop_qcs404_resets,
1388c2ecf20Sopenharmony_ci	.num_resets = ARRAY_SIZE(q6sstop_qcs404_resets),
1398c2ecf20Sopenharmony_ci};
1408c2ecf20Sopenharmony_ci
1418c2ecf20Sopenharmony_cistatic struct clk_regmap *tcsr_qcs404_clocks[] = {
1428c2ecf20Sopenharmony_ci	[TCSR_Q6SS_LCC_CBCR_CLK] = &tcsr_lcc_csr_cbcr_clk.clkr,
1438c2ecf20Sopenharmony_ci};
1448c2ecf20Sopenharmony_ci
1458c2ecf20Sopenharmony_cistatic const struct qcom_cc_desc tcsr_qcs404_desc = {
1468c2ecf20Sopenharmony_ci	.config = &q6sstop_regmap_config,
1478c2ecf20Sopenharmony_ci	.clks = tcsr_qcs404_clocks,
1488c2ecf20Sopenharmony_ci	.num_clks = ARRAY_SIZE(tcsr_qcs404_clocks),
1498c2ecf20Sopenharmony_ci};
1508c2ecf20Sopenharmony_ci
1518c2ecf20Sopenharmony_cistatic const struct of_device_id q6sstopcc_qcs404_match_table[] = {
1528c2ecf20Sopenharmony_ci	{ .compatible = "qcom,qcs404-q6sstopcc" },
1538c2ecf20Sopenharmony_ci	{ }
1548c2ecf20Sopenharmony_ci};
1558c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(of, q6sstopcc_qcs404_match_table);
1568c2ecf20Sopenharmony_ci
1578c2ecf20Sopenharmony_cistatic int q6sstopcc_qcs404_probe(struct platform_device *pdev)
1588c2ecf20Sopenharmony_ci{
1598c2ecf20Sopenharmony_ci	const struct qcom_cc_desc *desc;
1608c2ecf20Sopenharmony_ci	int ret;
1618c2ecf20Sopenharmony_ci
1628c2ecf20Sopenharmony_ci	pm_runtime_enable(&pdev->dev);
1638c2ecf20Sopenharmony_ci	ret = pm_clk_create(&pdev->dev);
1648c2ecf20Sopenharmony_ci	if (ret)
1658c2ecf20Sopenharmony_ci		goto disable_pm_runtime;
1668c2ecf20Sopenharmony_ci
1678c2ecf20Sopenharmony_ci	ret = pm_clk_add(&pdev->dev, NULL);
1688c2ecf20Sopenharmony_ci	if (ret < 0) {
1698c2ecf20Sopenharmony_ci		dev_err(&pdev->dev, "failed to acquire iface clock\n");
1708c2ecf20Sopenharmony_ci		goto destroy_pm_clk;
1718c2ecf20Sopenharmony_ci	}
1728c2ecf20Sopenharmony_ci
1738c2ecf20Sopenharmony_ci	q6sstop_regmap_config.name = "q6sstop_tcsr";
1748c2ecf20Sopenharmony_ci	desc = &tcsr_qcs404_desc;
1758c2ecf20Sopenharmony_ci
1768c2ecf20Sopenharmony_ci	ret = qcom_cc_probe_by_index(pdev, 1, desc);
1778c2ecf20Sopenharmony_ci	if (ret)
1788c2ecf20Sopenharmony_ci		goto destroy_pm_clk;
1798c2ecf20Sopenharmony_ci
1808c2ecf20Sopenharmony_ci	q6sstop_regmap_config.name = "q6sstop_cc";
1818c2ecf20Sopenharmony_ci	desc = &q6sstop_qcs404_desc;
1828c2ecf20Sopenharmony_ci
1838c2ecf20Sopenharmony_ci	ret = qcom_cc_probe_by_index(pdev, 0, desc);
1848c2ecf20Sopenharmony_ci	if (ret)
1858c2ecf20Sopenharmony_ci		goto destroy_pm_clk;
1868c2ecf20Sopenharmony_ci
1878c2ecf20Sopenharmony_ci	return 0;
1888c2ecf20Sopenharmony_ci
1898c2ecf20Sopenharmony_cidestroy_pm_clk:
1908c2ecf20Sopenharmony_ci	pm_clk_destroy(&pdev->dev);
1918c2ecf20Sopenharmony_ci
1928c2ecf20Sopenharmony_cidisable_pm_runtime:
1938c2ecf20Sopenharmony_ci	pm_runtime_disable(&pdev->dev);
1948c2ecf20Sopenharmony_ci
1958c2ecf20Sopenharmony_ci	return ret;
1968c2ecf20Sopenharmony_ci}
1978c2ecf20Sopenharmony_ci
1988c2ecf20Sopenharmony_cistatic int q6sstopcc_qcs404_remove(struct platform_device *pdev)
1998c2ecf20Sopenharmony_ci{
2008c2ecf20Sopenharmony_ci	pm_clk_destroy(&pdev->dev);
2018c2ecf20Sopenharmony_ci	pm_runtime_disable(&pdev->dev);
2028c2ecf20Sopenharmony_ci
2038c2ecf20Sopenharmony_ci	return 0;
2048c2ecf20Sopenharmony_ci}
2058c2ecf20Sopenharmony_ci
2068c2ecf20Sopenharmony_cistatic const struct dev_pm_ops q6sstopcc_pm_ops = {
2078c2ecf20Sopenharmony_ci	SET_RUNTIME_PM_OPS(pm_clk_suspend, pm_clk_resume, NULL)
2088c2ecf20Sopenharmony_ci};
2098c2ecf20Sopenharmony_ci
2108c2ecf20Sopenharmony_cistatic struct platform_driver q6sstopcc_qcs404_driver = {
2118c2ecf20Sopenharmony_ci	.probe		= q6sstopcc_qcs404_probe,
2128c2ecf20Sopenharmony_ci	.remove		= q6sstopcc_qcs404_remove,
2138c2ecf20Sopenharmony_ci	.driver		= {
2148c2ecf20Sopenharmony_ci		.name	= "qcs404-q6sstopcc",
2158c2ecf20Sopenharmony_ci		.of_match_table = q6sstopcc_qcs404_match_table,
2168c2ecf20Sopenharmony_ci		.pm = &q6sstopcc_pm_ops,
2178c2ecf20Sopenharmony_ci	},
2188c2ecf20Sopenharmony_ci};
2198c2ecf20Sopenharmony_ci
2208c2ecf20Sopenharmony_cimodule_platform_driver(q6sstopcc_qcs404_driver);
2218c2ecf20Sopenharmony_ci
2228c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("QTI QCS404 Q6SSTOP Clock Controller Driver");
2238c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL v2");
224