162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright (c) 2018, The Linux Foundation. All rights reserved.
462306a36Sopenharmony_ci */
562306a36Sopenharmony_ci
662306a36Sopenharmony_ci#include <linux/bitops.h>
762306a36Sopenharmony_ci#include <linux/clk-provider.h>
862306a36Sopenharmony_ci#include <linux/err.h>
962306a36Sopenharmony_ci#include <linux/module.h>
1062306a36Sopenharmony_ci#include <linux/platform_device.h>
1162306a36Sopenharmony_ci#include <linux/pm_clock.h>
1262306a36Sopenharmony_ci#include <linux/pm_runtime.h>
1362306a36Sopenharmony_ci#include <linux/regmap.h>
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_ci#include <dt-bindings/clock/qcom,q6sstopcc-qcs404.h>
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#include "clk-regmap.h"
1862306a36Sopenharmony_ci#include "clk-branch.h"
1962306a36Sopenharmony_ci#include "common.h"
2062306a36Sopenharmony_ci#include "reset.h"
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_cistatic struct clk_branch lcc_ahbfabric_cbc_clk = {
2362306a36Sopenharmony_ci	.halt_reg = 0x1b004,
2462306a36Sopenharmony_ci	.halt_check = BRANCH_HALT,
2562306a36Sopenharmony_ci	.clkr = {
2662306a36Sopenharmony_ci		.enable_reg = 0x1b004,
2762306a36Sopenharmony_ci		.enable_mask = BIT(0),
2862306a36Sopenharmony_ci		.hw.init = &(struct clk_init_data){
2962306a36Sopenharmony_ci			.name = "lcc_ahbfabric_cbc_clk",
3062306a36Sopenharmony_ci			.ops = &clk_branch2_ops,
3162306a36Sopenharmony_ci		},
3262306a36Sopenharmony_ci	},
3362306a36Sopenharmony_ci};
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_cistatic struct clk_branch lcc_q6ss_ahbs_cbc_clk = {
3662306a36Sopenharmony_ci	.halt_reg = 0x22000,
3762306a36Sopenharmony_ci	.halt_check = BRANCH_VOTED,
3862306a36Sopenharmony_ci	.clkr = {
3962306a36Sopenharmony_ci		.enable_reg = 0x22000,
4062306a36Sopenharmony_ci		.enable_mask = BIT(0),
4162306a36Sopenharmony_ci		.hw.init = &(struct clk_init_data){
4262306a36Sopenharmony_ci			.name = "lcc_q6ss_ahbs_cbc_clk",
4362306a36Sopenharmony_ci			.ops = &clk_branch2_ops,
4462306a36Sopenharmony_ci		},
4562306a36Sopenharmony_ci	},
4662306a36Sopenharmony_ci};
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_cistatic struct clk_branch lcc_q6ss_tcm_slave_cbc_clk = {
4962306a36Sopenharmony_ci	.halt_reg = 0x1c000,
5062306a36Sopenharmony_ci	.halt_check = BRANCH_VOTED,
5162306a36Sopenharmony_ci	.clkr = {
5262306a36Sopenharmony_ci		.enable_reg = 0x1c000,
5362306a36Sopenharmony_ci		.enable_mask = BIT(0),
5462306a36Sopenharmony_ci		.hw.init = &(struct clk_init_data){
5562306a36Sopenharmony_ci			.name = "lcc_q6ss_tcm_slave_cbc_clk",
5662306a36Sopenharmony_ci			.ops = &clk_branch2_ops,
5762306a36Sopenharmony_ci		},
5862306a36Sopenharmony_ci	},
5962306a36Sopenharmony_ci};
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_cistatic struct clk_branch lcc_q6ss_ahbm_cbc_clk = {
6262306a36Sopenharmony_ci	.halt_reg = 0x22004,
6362306a36Sopenharmony_ci	.halt_check = BRANCH_VOTED,
6462306a36Sopenharmony_ci	.clkr = {
6562306a36Sopenharmony_ci		.enable_reg = 0x22004,
6662306a36Sopenharmony_ci		.enable_mask = BIT(0),
6762306a36Sopenharmony_ci		.hw.init = &(struct clk_init_data){
6862306a36Sopenharmony_ci			.name = "lcc_q6ss_ahbm_cbc_clk",
6962306a36Sopenharmony_ci			.ops = &clk_branch2_ops,
7062306a36Sopenharmony_ci		},
7162306a36Sopenharmony_ci	},
7262306a36Sopenharmony_ci};
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_cistatic struct clk_branch lcc_q6ss_axim_cbc_clk = {
7562306a36Sopenharmony_ci	.halt_reg = 0x1c004,
7662306a36Sopenharmony_ci	.halt_check = BRANCH_VOTED,
7762306a36Sopenharmony_ci	.clkr = {
7862306a36Sopenharmony_ci		.enable_reg = 0x1c004,
7962306a36Sopenharmony_ci		.enable_mask = BIT(0),
8062306a36Sopenharmony_ci		.hw.init = &(struct clk_init_data){
8162306a36Sopenharmony_ci			.name = "lcc_q6ss_axim_cbc_clk",
8262306a36Sopenharmony_ci			.ops = &clk_branch2_ops,
8362306a36Sopenharmony_ci		},
8462306a36Sopenharmony_ci	},
8562306a36Sopenharmony_ci};
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_cistatic struct clk_branch lcc_q6ss_bcr_sleep_clk = {
8862306a36Sopenharmony_ci	.halt_reg = 0x6004,
8962306a36Sopenharmony_ci	.halt_check = BRANCH_VOTED,
9062306a36Sopenharmony_ci	.clkr = {
9162306a36Sopenharmony_ci		.enable_reg = 0x6004,
9262306a36Sopenharmony_ci		.enable_mask = BIT(0),
9362306a36Sopenharmony_ci		.hw.init = &(struct clk_init_data){
9462306a36Sopenharmony_ci			.name = "lcc_q6ss_bcr_sleep_clk",
9562306a36Sopenharmony_ci			.ops = &clk_branch2_ops,
9662306a36Sopenharmony_ci		},
9762306a36Sopenharmony_ci	},
9862306a36Sopenharmony_ci};
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ci/* TCSR clock */
10162306a36Sopenharmony_cistatic struct clk_branch tcsr_lcc_csr_cbcr_clk = {
10262306a36Sopenharmony_ci	.halt_reg = 0x8008,
10362306a36Sopenharmony_ci	.halt_check = BRANCH_VOTED,
10462306a36Sopenharmony_ci	.clkr = {
10562306a36Sopenharmony_ci		.enable_reg = 0x8008,
10662306a36Sopenharmony_ci		.enable_mask = BIT(0),
10762306a36Sopenharmony_ci		.hw.init = &(struct clk_init_data){
10862306a36Sopenharmony_ci			.name = "tcsr_lcc_csr_cbcr_clk",
10962306a36Sopenharmony_ci			.ops = &clk_branch2_ops,
11062306a36Sopenharmony_ci		},
11162306a36Sopenharmony_ci	},
11262306a36Sopenharmony_ci};
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_cistatic struct regmap_config q6sstop_regmap_config = {
11562306a36Sopenharmony_ci	.reg_bits	= 32,
11662306a36Sopenharmony_ci	.reg_stride	= 4,
11762306a36Sopenharmony_ci	.val_bits	= 32,
11862306a36Sopenharmony_ci	.fast_io	= true,
11962306a36Sopenharmony_ci};
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_cistatic struct clk_regmap *q6sstop_qcs404_clocks[] = {
12262306a36Sopenharmony_ci	[LCC_AHBFABRIC_CBC_CLK] = &lcc_ahbfabric_cbc_clk.clkr,
12362306a36Sopenharmony_ci	[LCC_Q6SS_AHBS_CBC_CLK] = &lcc_q6ss_ahbs_cbc_clk.clkr,
12462306a36Sopenharmony_ci	[LCC_Q6SS_TCM_SLAVE_CBC_CLK] = &lcc_q6ss_tcm_slave_cbc_clk.clkr,
12562306a36Sopenharmony_ci	[LCC_Q6SS_AHBM_CBC_CLK] = &lcc_q6ss_ahbm_cbc_clk.clkr,
12662306a36Sopenharmony_ci	[LCC_Q6SS_AXIM_CBC_CLK] = &lcc_q6ss_axim_cbc_clk.clkr,
12762306a36Sopenharmony_ci	[LCC_Q6SS_BCR_SLEEP_CLK] = &lcc_q6ss_bcr_sleep_clk.clkr,
12862306a36Sopenharmony_ci};
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_cistatic const struct qcom_reset_map q6sstop_qcs404_resets[] = {
13162306a36Sopenharmony_ci	[Q6SSTOP_BCR_RESET] = { 0x6000 },
13262306a36Sopenharmony_ci};
13362306a36Sopenharmony_ci
13462306a36Sopenharmony_cistatic const struct qcom_cc_desc q6sstop_qcs404_desc = {
13562306a36Sopenharmony_ci	.config = &q6sstop_regmap_config,
13662306a36Sopenharmony_ci	.clks = q6sstop_qcs404_clocks,
13762306a36Sopenharmony_ci	.num_clks = ARRAY_SIZE(q6sstop_qcs404_clocks),
13862306a36Sopenharmony_ci	.resets = q6sstop_qcs404_resets,
13962306a36Sopenharmony_ci	.num_resets = ARRAY_SIZE(q6sstop_qcs404_resets),
14062306a36Sopenharmony_ci};
14162306a36Sopenharmony_ci
14262306a36Sopenharmony_cistatic struct clk_regmap *tcsr_qcs404_clocks[] = {
14362306a36Sopenharmony_ci	[TCSR_Q6SS_LCC_CBCR_CLK] = &tcsr_lcc_csr_cbcr_clk.clkr,
14462306a36Sopenharmony_ci};
14562306a36Sopenharmony_ci
14662306a36Sopenharmony_cistatic const struct qcom_cc_desc tcsr_qcs404_desc = {
14762306a36Sopenharmony_ci	.config = &q6sstop_regmap_config,
14862306a36Sopenharmony_ci	.clks = tcsr_qcs404_clocks,
14962306a36Sopenharmony_ci	.num_clks = ARRAY_SIZE(tcsr_qcs404_clocks),
15062306a36Sopenharmony_ci};
15162306a36Sopenharmony_ci
15262306a36Sopenharmony_cistatic const struct of_device_id q6sstopcc_qcs404_match_table[] = {
15362306a36Sopenharmony_ci	{ .compatible = "qcom,qcs404-q6sstopcc" },
15462306a36Sopenharmony_ci	{ }
15562306a36Sopenharmony_ci};
15662306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, q6sstopcc_qcs404_match_table);
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_cistatic int q6sstopcc_qcs404_probe(struct platform_device *pdev)
15962306a36Sopenharmony_ci{
16062306a36Sopenharmony_ci	const struct qcom_cc_desc *desc;
16162306a36Sopenharmony_ci	int ret;
16262306a36Sopenharmony_ci
16362306a36Sopenharmony_ci	ret = devm_pm_runtime_enable(&pdev->dev);
16462306a36Sopenharmony_ci	if (ret)
16562306a36Sopenharmony_ci		return ret;
16662306a36Sopenharmony_ci
16762306a36Sopenharmony_ci	ret = devm_pm_clk_create(&pdev->dev);
16862306a36Sopenharmony_ci	if (ret)
16962306a36Sopenharmony_ci		return ret;
17062306a36Sopenharmony_ci
17162306a36Sopenharmony_ci	ret = pm_clk_add(&pdev->dev, NULL);
17262306a36Sopenharmony_ci	if (ret < 0) {
17362306a36Sopenharmony_ci		dev_err(&pdev->dev, "failed to acquire iface clock\n");
17462306a36Sopenharmony_ci		return ret;
17562306a36Sopenharmony_ci	}
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci	ret = pm_runtime_resume_and_get(&pdev->dev);
17862306a36Sopenharmony_ci	if (ret)
17962306a36Sopenharmony_ci		return ret;
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_ci	q6sstop_regmap_config.name = "q6sstop_tcsr";
18262306a36Sopenharmony_ci	desc = &tcsr_qcs404_desc;
18362306a36Sopenharmony_ci
18462306a36Sopenharmony_ci	ret = qcom_cc_probe_by_index(pdev, 1, desc);
18562306a36Sopenharmony_ci	if (ret)
18662306a36Sopenharmony_ci		goto err_put_rpm;
18762306a36Sopenharmony_ci
18862306a36Sopenharmony_ci	q6sstop_regmap_config.name = "q6sstop_cc";
18962306a36Sopenharmony_ci	desc = &q6sstop_qcs404_desc;
19062306a36Sopenharmony_ci
19162306a36Sopenharmony_ci	ret = qcom_cc_probe_by_index(pdev, 0, desc);
19262306a36Sopenharmony_ci	if (ret)
19362306a36Sopenharmony_ci		goto err_put_rpm;
19462306a36Sopenharmony_ci
19562306a36Sopenharmony_ci	pm_runtime_put(&pdev->dev);
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_ci	return 0;
19862306a36Sopenharmony_ci
19962306a36Sopenharmony_cierr_put_rpm:
20062306a36Sopenharmony_ci	pm_runtime_put_sync(&pdev->dev);
20162306a36Sopenharmony_ci
20262306a36Sopenharmony_ci	return ret;
20362306a36Sopenharmony_ci}
20462306a36Sopenharmony_ci
20562306a36Sopenharmony_cistatic const struct dev_pm_ops q6sstopcc_pm_ops = {
20662306a36Sopenharmony_ci	SET_RUNTIME_PM_OPS(pm_clk_suspend, pm_clk_resume, NULL)
20762306a36Sopenharmony_ci};
20862306a36Sopenharmony_ci
20962306a36Sopenharmony_cistatic struct platform_driver q6sstopcc_qcs404_driver = {
21062306a36Sopenharmony_ci	.probe		= q6sstopcc_qcs404_probe,
21162306a36Sopenharmony_ci	.driver		= {
21262306a36Sopenharmony_ci		.name	= "qcs404-q6sstopcc",
21362306a36Sopenharmony_ci		.of_match_table = q6sstopcc_qcs404_match_table,
21462306a36Sopenharmony_ci		.pm = &q6sstopcc_pm_ops,
21562306a36Sopenharmony_ci	},
21662306a36Sopenharmony_ci};
21762306a36Sopenharmony_ci
21862306a36Sopenharmony_cimodule_platform_driver(q6sstopcc_qcs404_driver);
21962306a36Sopenharmony_ci
22062306a36Sopenharmony_ciMODULE_DESCRIPTION("QTI QCS404 Q6SSTOP Clock Controller Driver");
22162306a36Sopenharmony_ciMODULE_LICENSE("GPL v2");
222