1 // SPDX-License-Identifier: GPL-2.0-only
7 #include <linux/dma-mapping.h>
12 #include <soc/tegra/bpmp.h>
13 #include <soc/tegra/bpmp-abi.h>
26 #define NO_CPU -1
61 	for (i = 0; i < data->num_clusters; i++) {  in tegra186_cpufreq_init()
62 		struct tegra186_cpufreq_cluster *cluster = &data->clusters[i];  in tegra186_cpufreq_init()
64 			cluster->info;  in tegra186_cpufreq_init()
67 		for (core = 0; core < ARRAY_SIZE(info->cpus); core++) {  in tegra186_cpufreq_init()
68 			if (info->cpus[core] == policy->cpu)  in tegra186_cpufreq_init()
71 		if (core == ARRAY_SIZE(info->cpus))  in tegra186_cpufreq_init()
74 		policy->driver_data =  in tegra186_cpufreq_init()
75 			data->regs + info->offset + EDVD_CORE_VOLT_FREQ(core);  in tegra186_cpufreq_init()
76 		policy->freq_table = cluster->table;  in tegra186_cpufreq_init()
80 	policy->cpuinfo.transition_latency = 300 * 1000;  in tegra186_cpufreq_init()
88 	struct cpufreq_frequency_table *tbl = policy->freq_table + index;  in tegra186_cpufreq_set_target()
89 	void __iomem *edvd_reg = policy->driver_data;  in tegra186_cpufreq_set_target()
90 	u32 edvd_val = tbl->driver_data;  in tegra186_cpufreq_set_target()
109 	edvd_reg = policy->driver_data;  in tegra186_cpufreq_get()
112 	for (i = 0; i < data->num_clusters; i++) {  in tegra186_cpufreq_get()
113 		struct tegra186_cpufreq_cluster *cluster = &data->clusters[i];  in tegra186_cpufreq_get()
116 		for (core = 0; core < ARRAY_SIZE(cluster->info->cpus); core++) {  in tegra186_cpufreq_get()
117 			if (cluster->info->cpus[core] != policy->cpu)  in tegra186_cpufreq_get()
120 			freq = (cluster->ref_clk_khz * ndiv) / cluster->div;  in tegra186_cpufreq_get()
132 	.name = "tegra186",
143 	struct platform_device *pdev, struct tegra_bpmp *bpmp,  in init_vhint_table()  argument
154 	virt = dma_alloc_coherent(bpmp->dev, sizeof(*data), &phys,  in init_vhint_table()
157 		return ERR_PTR(-ENOMEM);  in init_vhint_table()
163 	req.cluster_id = cluster->info->bpmp_cluster_id;  in init_vhint_table()
170 	err = tegra_bpmp_transfer(bpmp, &msg);  in init_vhint_table()
176 	for (i = data->vfloor; i <= data->vceil; i++) {  in init_vhint_table()
177 		u16 ndiv = data->ndiv[i];  in init_vhint_table()
179 		if (ndiv < data->ndiv_min || ndiv > data->ndiv_max)  in init_vhint_table()
183 		if (i > 0 && ndiv == data->ndiv[i - 1])  in init_vhint_table()
189 	table = devm_kcalloc(&pdev->dev, num_rates + 1, sizeof(*table),  in init_vhint_table()
192 		table = ERR_PTR(-ENOMEM);  in init_vhint_table()
196 	cluster->ref_clk_khz = data->ref_clk_hz / 1000;  in init_vhint_table()
197 	cluster->div = data->pdiv * data->mdiv;  in init_vhint_table()
199 	for (i = data->vfloor, j = 0; i <= data->vceil; i++) {  in init_vhint_table()
201 		u16 ndiv = data->ndiv[i];  in init_vhint_table()
204 		if (ndiv < data->ndiv_min || ndiv > data->ndiv_max)  in init_vhint_table()
208 		if (i > 0 && ndiv == data->ndiv[i - 1])  in init_vhint_table()
215 		point->driver_data = edvd_val;  in init_vhint_table()
216 		point->frequency = (cluster->ref_clk_khz * ndiv) / cluster->div;  in init_vhint_table()
222 	dma_free_coherent(bpmp->dev, sizeof(*data), virt, phys);  in init_vhint_table()
230 	struct tegra_bpmp *bpmp;  in tegra186_cpufreq_probe()  local
233 	data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);  in tegra186_cpufreq_probe()
235 		return -ENOMEM;  in tegra186_cpufreq_probe()
237 	data->clusters = devm_kcalloc(&pdev->dev, ARRAY_SIZE(tegra186_clusters),  in tegra186_cpufreq_probe()
238 				      sizeof(*data->clusters), GFP_KERNEL);  in tegra186_cpufreq_probe()
239 	if (!data->clusters)  in tegra186_cpufreq_probe()
240 		return -ENOMEM;  in tegra186_cpufreq_probe()
242 	data->num_clusters = ARRAY_SIZE(tegra186_clusters);  in tegra186_cpufreq_probe()
244 	bpmp = tegra_bpmp_get(&pdev->dev);  in tegra186_cpufreq_probe()
245 	if (IS_ERR(bpmp))  in tegra186_cpufreq_probe()
246 		return PTR_ERR(bpmp);  in tegra186_cpufreq_probe()
248 	data->regs = devm_platform_ioremap_resource(pdev, 0);  in tegra186_cpufreq_probe()
249 	if (IS_ERR(data->regs)) {  in tegra186_cpufreq_probe()
250 		err = PTR_ERR(data->regs);  in tegra186_cpufreq_probe()
254 	for (i = 0; i < data->num_clusters; i++) {  in tegra186_cpufreq_probe()
255 		struct tegra186_cpufreq_cluster *cluster = &data->clusters[i];  in tegra186_cpufreq_probe()
257 		cluster->info = &tegra186_clusters[i];  in tegra186_cpufreq_probe()
258 		cluster->table = init_vhint_table(pdev, bpmp, cluster);  in tegra186_cpufreq_probe()
259 		if (IS_ERR(cluster->table)) {  in tegra186_cpufreq_probe()
260 			err = PTR_ERR(cluster->table);  in tegra186_cpufreq_probe()
270 	tegra_bpmp_put(bpmp);  in tegra186_cpufreq_probe()
283 	{ .compatible = "nvidia,tegra186-ccplex-cluster", },
290 		.name = "tegra186-cpufreq",
299 MODULE_DESCRIPTION("NVIDIA Tegra186 cpufreq driver");