1 /* 2 * Marvell Armada 39x SoC clocks 3 * 4 * Copyright (C) 2015 Marvell 5 * 6 * Gregory CLEMENT <gregory.clement@free-electrons.com> 7 * Sebastian Hesselbarth <sebastian.hesselbarth@gmail.com> 8 * Andrew Lunn <andrew@lunn.ch> 9 * Thomas Petazzoni <thomas.petazzoni@free-electrons.com> 10 * 11 * This file is licensed under the terms of the GNU General Public 12 * License version 2. This program is licensed "as is" without any 13 * warranty of any kind, whether express or implied. 14 */ 15 16 #include <linux/kernel.h> 17 #include <linux/clk-provider.h> 18 #include <linux/io.h> 19 #include <linux/of.h> 20 #include "common.h" 21 22 /* 23 * SARL[14:10] : Ratios between CPU, NBCLK, HCLK and DCLK. 24 * 25 * SARL[15] : TCLK frequency 26 * 0 = 250 MHz 27 * 1 = 200 MHz 28 * 29 * SARH[0] : Reference clock frequency 30 * 0 = 25 Mhz 31 * 1 = 40 Mhz 32 */ 33 34 #define SARL 0 35 #define SARL_A390_TCLK_FREQ_OPT 15 36 #define SARL_A390_TCLK_FREQ_OPT_MASK 0x1 37 #define SARL_A390_CPU_DDR_L2_FREQ_OPT 10 38 #define SARL_A390_CPU_DDR_L2_FREQ_OPT_MASK 0x1F 39 #define SARH 4 40 #define SARH_A390_REFCLK_FREQ BIT(0) 41 42 static const u32 armada_39x_tclk_frequencies[] __initconst = { 43 250000000, 44 200000000, 45 }; 46 47 static u32 __init armada_39x_get_tclk_freq(void __iomem *sar) 48 { 49 u8 tclk_freq_select; 50 51 tclk_freq_select = ((readl(sar + SARL) >> SARL_A390_TCLK_FREQ_OPT) & 52 SARL_A390_TCLK_FREQ_OPT_MASK); 53 return armada_39x_tclk_frequencies[tclk_freq_select]; 54 } 55 56 static const u32 armada_39x_cpu_frequencies[] __initconst = { 57 [0x0] = 666 * 1000 * 1000, 58 [0x2] = 800 * 1000 * 1000, 59 [0x3] = 800 * 1000 * 1000, 60 [0x4] = 1066 * 1000 * 1000, 61 [0x5] = 1066 * 1000 * 1000, 62 [0x6] = 1200 * 1000 * 1000, 63 [0x8] = 1332 * 1000 * 1000, 64 [0xB] = 1600 * 1000 * 1000, 65 [0xC] = 1600 * 1000 * 1000, 66 [0x12] = 1800 * 1000 * 1000, 67 [0x1E] = 1800 * 1000 * 1000, 68 }; 69 70 static u32 __init armada_39x_get_cpu_freq(void __iomem *sar) 71 { 72 u8 cpu_freq_select; 73 74 cpu_freq_select = ((readl(sar + SARL) >> SARL_A390_CPU_DDR_L2_FREQ_OPT) & 75 SARL_A390_CPU_DDR_L2_FREQ_OPT_MASK); 76 if (cpu_freq_select >= ARRAY_SIZE(armada_39x_cpu_frequencies)) { 77 pr_err("Selected CPU frequency (%d) unsupported\n", 78 cpu_freq_select); 79 return 0; 80 } 81 82 return armada_39x_cpu_frequencies[cpu_freq_select]; 83 } 84 85 enum { A390_CPU_TO_NBCLK, A390_CPU_TO_HCLK, A390_CPU_TO_DCLK }; 86 87 static const struct coreclk_ratio armada_39x_coreclk_ratios[] __initconst = { 88 { .id = A390_CPU_TO_NBCLK, .name = "nbclk" }, 89 { .id = A390_CPU_TO_HCLK, .name = "hclk" }, 90 { .id = A390_CPU_TO_DCLK, .name = "dclk" }, 91 }; 92 93 static void __init armada_39x_get_clk_ratio( 94 void __iomem *sar, int id, int *mult, int *div) 95 { 96 switch (id) { 97 case A390_CPU_TO_NBCLK: 98 *mult = 1; 99 *div = 2; 100 break; 101 case A390_CPU_TO_HCLK: 102 *mult = 1; 103 *div = 4; 104 break; 105 case A390_CPU_TO_DCLK: 106 *mult = 1; 107 *div = 2; 108 break; 109 } 110 } 111 112 static u32 __init armada_39x_refclk_ratio(void __iomem *sar) 113 { 114 if (readl(sar + SARH) & SARH_A390_REFCLK_FREQ) 115 return 40 * 1000 * 1000; 116 else 117 return 25 * 1000 * 1000; 118 } 119 120 static const struct coreclk_soc_desc armada_39x_coreclks = { 121 .get_tclk_freq = armada_39x_get_tclk_freq, 122 .get_cpu_freq = armada_39x_get_cpu_freq, 123 .get_clk_ratio = armada_39x_get_clk_ratio, 124 .get_refclk_freq = armada_39x_refclk_ratio, 125 .ratios = armada_39x_coreclk_ratios, 126 .num_ratios = ARRAY_SIZE(armada_39x_coreclk_ratios), 127 }; 128 129 static void __init armada_39x_coreclk_init(struct device_node *np) 130 { 131 mvebu_coreclk_setup(np, &armada_39x_coreclks); 132 } 133 CLK_OF_DECLARE(armada_39x_core_clk, "marvell,armada-390-core-clock", 134 armada_39x_coreclk_init); 135 136 /* 137 * Clock Gating Control 138 */ 139 static const struct clk_gating_soc_desc armada_39x_gating_desc[] __initconst = { 140 { "pex1", NULL, 5 }, 141 { "pex2", NULL, 6 }, 142 { "pex3", NULL, 7 }, 143 { "pex0", NULL, 8 }, 144 { "usb3h0", NULL, 9 }, 145 { "usb3h1", NULL, 10 }, 146 { "sata0", NULL, 15 }, 147 { "sdio", NULL, 17 }, 148 { "xor0", NULL, 22 }, 149 { "xor1", NULL, 28 }, 150 { } 151 }; 152 153 static void __init armada_39x_clk_gating_init(struct device_node *np) 154 { 155 mvebu_clk_gating_setup(np, armada_39x_gating_desc); 156 } 157 CLK_OF_DECLARE(armada_39x_clk_gating, "marvell,armada-390-gating-clock", 158 armada_39x_clk_gating_init); 159