162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Marvell Armada 380/385 SoC clocks
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2014 Marvell
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * Gregory CLEMENT <gregory.clement@free-electrons.com>
862306a36Sopenharmony_ci * Sebastian Hesselbarth <sebastian.hesselbarth@gmail.com>
962306a36Sopenharmony_ci * Andrew Lunn <andrew@lunn.ch>
1062306a36Sopenharmony_ci *
1162306a36Sopenharmony_ci */
1262306a36Sopenharmony_ci
1362306a36Sopenharmony_ci#include <linux/kernel.h>
1462306a36Sopenharmony_ci#include <linux/clk-provider.h>
1562306a36Sopenharmony_ci#include <linux/io.h>
1662306a36Sopenharmony_ci#include <linux/of.h>
1762306a36Sopenharmony_ci#include "common.h"
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_ci/*
2062306a36Sopenharmony_ci * SAR[14:10] : Ratios between PCLK0, NBCLK, HCLK and DRAM clocks
2162306a36Sopenharmony_ci *
2262306a36Sopenharmony_ci * SAR[15]    : TCLK frequency
2362306a36Sopenharmony_ci *		 0 = 250 MHz
2462306a36Sopenharmony_ci *		 1 = 200 MHz
2562306a36Sopenharmony_ci */
2662306a36Sopenharmony_ci
2762306a36Sopenharmony_ci#define SAR_A380_TCLK_FREQ_OPT		  15
2862306a36Sopenharmony_ci#define SAR_A380_TCLK_FREQ_OPT_MASK	  0x1
2962306a36Sopenharmony_ci#define SAR_A380_CPU_DDR_L2_FREQ_OPT	  10
3062306a36Sopenharmony_ci#define SAR_A380_CPU_DDR_L2_FREQ_OPT_MASK 0x1F
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_cistatic const u32 armada_38x_tclk_frequencies[] __initconst = {
3362306a36Sopenharmony_ci	250000000,
3462306a36Sopenharmony_ci	200000000,
3562306a36Sopenharmony_ci};
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_cistatic u32 __init armada_38x_get_tclk_freq(void __iomem *sar)
3862306a36Sopenharmony_ci{
3962306a36Sopenharmony_ci	u8 tclk_freq_select;
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_ci	tclk_freq_select = ((readl(sar) >> SAR_A380_TCLK_FREQ_OPT) &
4262306a36Sopenharmony_ci			    SAR_A380_TCLK_FREQ_OPT_MASK);
4362306a36Sopenharmony_ci	return armada_38x_tclk_frequencies[tclk_freq_select];
4462306a36Sopenharmony_ci}
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_cistatic const u32 armada_38x_cpu_frequencies[] __initconst = {
4762306a36Sopenharmony_ci	666 * 1000 * 1000,  0, 800 * 1000 * 1000, 0,
4862306a36Sopenharmony_ci	1066 * 1000 * 1000, 0, 1200 * 1000 * 1000, 0,
4962306a36Sopenharmony_ci	1332 * 1000 * 1000, 0, 0, 0,
5062306a36Sopenharmony_ci	1600 * 1000 * 1000, 0, 0, 0,
5162306a36Sopenharmony_ci	1866 * 1000 * 1000, 0, 0, 2000 * 1000 * 1000,
5262306a36Sopenharmony_ci};
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_cistatic u32 __init armada_38x_get_cpu_freq(void __iomem *sar)
5562306a36Sopenharmony_ci{
5662306a36Sopenharmony_ci	u8 cpu_freq_select;
5762306a36Sopenharmony_ci
5862306a36Sopenharmony_ci	cpu_freq_select = ((readl(sar) >> SAR_A380_CPU_DDR_L2_FREQ_OPT) &
5962306a36Sopenharmony_ci			   SAR_A380_CPU_DDR_L2_FREQ_OPT_MASK);
6062306a36Sopenharmony_ci	if (cpu_freq_select >= ARRAY_SIZE(armada_38x_cpu_frequencies)) {
6162306a36Sopenharmony_ci		pr_err("Selected CPU frequency (%d) unsupported\n",
6262306a36Sopenharmony_ci			cpu_freq_select);
6362306a36Sopenharmony_ci		return 0;
6462306a36Sopenharmony_ci	}
6562306a36Sopenharmony_ci
6662306a36Sopenharmony_ci	return armada_38x_cpu_frequencies[cpu_freq_select];
6762306a36Sopenharmony_ci}
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_cienum { A380_CPU_TO_DDR, A380_CPU_TO_L2 };
7062306a36Sopenharmony_ci
7162306a36Sopenharmony_cistatic const struct coreclk_ratio armada_38x_coreclk_ratios[] __initconst = {
7262306a36Sopenharmony_ci	{ .id = A380_CPU_TO_L2,	 .name = "l2clk" },
7362306a36Sopenharmony_ci	{ .id = A380_CPU_TO_DDR, .name = "ddrclk" },
7462306a36Sopenharmony_ci};
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_cistatic const int armada_38x_cpu_l2_ratios[32][2] __initconst = {
7762306a36Sopenharmony_ci	{1, 2}, {0, 1}, {1, 2}, {0, 1},
7862306a36Sopenharmony_ci	{1, 2}, {0, 1}, {1, 2}, {0, 1},
7962306a36Sopenharmony_ci	{1, 2}, {0, 1}, {0, 1}, {0, 1},
8062306a36Sopenharmony_ci	{1, 2}, {0, 1}, {0, 1}, {0, 1},
8162306a36Sopenharmony_ci	{1, 2}, {0, 1}, {0, 1}, {1, 2},
8262306a36Sopenharmony_ci	{0, 1}, {0, 1}, {0, 1}, {0, 1},
8362306a36Sopenharmony_ci	{0, 1}, {0, 1}, {0, 1}, {0, 1},
8462306a36Sopenharmony_ci	{0, 1}, {0, 1}, {0, 1}, {0, 1},
8562306a36Sopenharmony_ci};
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_cistatic const int armada_38x_cpu_ddr_ratios[32][2] __initconst = {
8862306a36Sopenharmony_ci	{0, 1}, {0, 1}, {0, 1}, {0, 1},
8962306a36Sopenharmony_ci	{1, 2}, {0, 1}, {0, 1}, {0, 1},
9062306a36Sopenharmony_ci	{1, 2}, {0, 1}, {0, 1}, {0, 1},
9162306a36Sopenharmony_ci	{1, 2}, {0, 1}, {0, 1}, {0, 1},
9262306a36Sopenharmony_ci	{1, 2}, {0, 1}, {0, 1}, {7, 15},
9362306a36Sopenharmony_ci	{0, 1}, {0, 1}, {0, 1}, {0, 1},
9462306a36Sopenharmony_ci	{0, 1}, {0, 1}, {0, 1}, {0, 1},
9562306a36Sopenharmony_ci	{0, 1}, {0, 1}, {0, 1}, {0, 1},
9662306a36Sopenharmony_ci};
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_cistatic void __init armada_38x_get_clk_ratio(
9962306a36Sopenharmony_ci	void __iomem *sar, int id, int *mult, int *div)
10062306a36Sopenharmony_ci{
10162306a36Sopenharmony_ci	u32 opt = ((readl(sar) >> SAR_A380_CPU_DDR_L2_FREQ_OPT) &
10262306a36Sopenharmony_ci		SAR_A380_CPU_DDR_L2_FREQ_OPT_MASK);
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci	switch (id) {
10562306a36Sopenharmony_ci	case A380_CPU_TO_L2:
10662306a36Sopenharmony_ci		*mult = armada_38x_cpu_l2_ratios[opt][0];
10762306a36Sopenharmony_ci		*div = armada_38x_cpu_l2_ratios[opt][1];
10862306a36Sopenharmony_ci		break;
10962306a36Sopenharmony_ci	case A380_CPU_TO_DDR:
11062306a36Sopenharmony_ci		*mult = armada_38x_cpu_ddr_ratios[opt][0];
11162306a36Sopenharmony_ci		*div = armada_38x_cpu_ddr_ratios[opt][1];
11262306a36Sopenharmony_ci		break;
11362306a36Sopenharmony_ci	}
11462306a36Sopenharmony_ci}
11562306a36Sopenharmony_ci
11662306a36Sopenharmony_cistatic const struct coreclk_soc_desc armada_38x_coreclks = {
11762306a36Sopenharmony_ci	.get_tclk_freq = armada_38x_get_tclk_freq,
11862306a36Sopenharmony_ci	.get_cpu_freq = armada_38x_get_cpu_freq,
11962306a36Sopenharmony_ci	.get_clk_ratio = armada_38x_get_clk_ratio,
12062306a36Sopenharmony_ci	.ratios = armada_38x_coreclk_ratios,
12162306a36Sopenharmony_ci	.num_ratios = ARRAY_SIZE(armada_38x_coreclk_ratios),
12262306a36Sopenharmony_ci};
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_cistatic void __init armada_38x_coreclk_init(struct device_node *np)
12562306a36Sopenharmony_ci{
12662306a36Sopenharmony_ci	mvebu_coreclk_setup(np, &armada_38x_coreclks);
12762306a36Sopenharmony_ci}
12862306a36Sopenharmony_ciCLK_OF_DECLARE(armada_38x_core_clk, "marvell,armada-380-core-clock",
12962306a36Sopenharmony_ci	       armada_38x_coreclk_init);
13062306a36Sopenharmony_ci
13162306a36Sopenharmony_ci/*
13262306a36Sopenharmony_ci * Clock Gating Control
13362306a36Sopenharmony_ci */
13462306a36Sopenharmony_cistatic const struct clk_gating_soc_desc armada_38x_gating_desc[] __initconst = {
13562306a36Sopenharmony_ci	{ "audio", NULL, 0 },
13662306a36Sopenharmony_ci	{ "ge2", NULL, 2 },
13762306a36Sopenharmony_ci	{ "ge1", NULL, 3 },
13862306a36Sopenharmony_ci	{ "ge0", NULL, 4 },
13962306a36Sopenharmony_ci	{ "pex1", NULL, 5 },
14062306a36Sopenharmony_ci	{ "pex2", NULL, 6 },
14162306a36Sopenharmony_ci	{ "pex3", NULL, 7 },
14262306a36Sopenharmony_ci	{ "pex0", NULL, 8 },
14362306a36Sopenharmony_ci	{ "usb3h0", NULL, 9 },
14462306a36Sopenharmony_ci	{ "usb3h1", NULL, 10 },
14562306a36Sopenharmony_ci	{ "usb3d", NULL, 11 },
14662306a36Sopenharmony_ci	{ "bm", NULL, 13 },
14762306a36Sopenharmony_ci	{ "crypto0z", NULL, 14 },
14862306a36Sopenharmony_ci	{ "sata0", NULL, 15 },
14962306a36Sopenharmony_ci	{ "crypto1z", NULL, 16 },
15062306a36Sopenharmony_ci	{ "sdio", NULL, 17 },
15162306a36Sopenharmony_ci	{ "usb2", NULL, 18 },
15262306a36Sopenharmony_ci	{ "crypto1", NULL, 21 },
15362306a36Sopenharmony_ci	{ "xor0", NULL, 22 },
15462306a36Sopenharmony_ci	{ "crypto0", NULL, 23 },
15562306a36Sopenharmony_ci	{ "tdm", NULL, 25 },
15662306a36Sopenharmony_ci	{ "xor1", NULL, 28 },
15762306a36Sopenharmony_ci	{ "sata1", NULL, 30 },
15862306a36Sopenharmony_ci	{ }
15962306a36Sopenharmony_ci};
16062306a36Sopenharmony_ci
16162306a36Sopenharmony_cistatic void __init armada_38x_clk_gating_init(struct device_node *np)
16262306a36Sopenharmony_ci{
16362306a36Sopenharmony_ci	mvebu_clk_gating_setup(np, armada_38x_gating_desc);
16462306a36Sopenharmony_ci}
16562306a36Sopenharmony_ciCLK_OF_DECLARE(armada_38x_clk_gating, "marvell,armada-380-gating-clock",
16662306a36Sopenharmony_ci	       armada_38x_clk_gating_init);
167