Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0 |
| 2 | /* |
| 3 | * Copyright (C) 2019, Intel Corporation |
| 4 | */ |
| 5 | #include <linux/slab.h> |
| 6 | #include <linux/clk-provider.h> |
| 7 | #include <linux/of_device.h> |
| 8 | #include <linux/of_address.h> |
| 9 | #include <linux/platform_device.h> |
| 10 | |
| 11 | #include <dt-bindings/clock/agilex-clock.h> |
| 12 | |
| 13 | #include "stratix10-clk.h" |
| 14 | |
| 15 | static const struct clk_parent_data pll_mux[] = { |
| 16 | { .fw_name = "osc1", |
| 17 | .name = "osc1", }, |
| 18 | { .fw_name = "cb-intosc-hs-div2-clk", |
| 19 | .name = "cb-intosc-hs-div2-clk", }, |
| 20 | { .fw_name = "f2s-free-clk", |
| 21 | .name = "f2s-free-clk", }, |
| 22 | }; |
| 23 | |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 24 | static const struct clk_parent_data boot_mux[] = { |
| 25 | { .fw_name = "osc1", |
| 26 | .name = "osc1", }, |
| 27 | { .fw_name = "cb-intosc-hs-div2-clk", |
| 28 | .name = "cb-intosc-hs-div2-clk", }, |
| 29 | }; |
| 30 | |
| 31 | static const struct clk_parent_data mpu_free_mux[] = { |
| 32 | { .fw_name = "main_pll_c0", |
| 33 | .name = "main_pll_c0", }, |
| 34 | { .fw_name = "peri_pll_c0", |
| 35 | .name = "peri_pll_c0", }, |
| 36 | { .fw_name = "osc1", |
| 37 | .name = "osc1", }, |
| 38 | { .fw_name = "cb-intosc-hs-div2-clk", |
| 39 | .name = "cb-intosc-hs-div2-clk", }, |
| 40 | { .fw_name = "f2s-free-clk", |
| 41 | .name = "f2s-free-clk", }, |
| 42 | }; |
| 43 | |
| 44 | static const struct clk_parent_data noc_free_mux[] = { |
| 45 | { .fw_name = "main_pll_c1", |
| 46 | .name = "main_pll_c1", }, |
| 47 | { .fw_name = "peri_pll_c1", |
| 48 | .name = "peri_pll_c1", }, |
| 49 | { .fw_name = "osc1", |
| 50 | .name = "osc1", }, |
| 51 | { .fw_name = "cb-intosc-hs-div2-clk", |
| 52 | .name = "cb-intosc-hs-div2-clk", }, |
| 53 | { .fw_name = "f2s-free-clk", |
| 54 | .name = "f2s-free-clk", }, |
| 55 | }; |
| 56 | |
| 57 | static const struct clk_parent_data emaca_free_mux[] = { |
| 58 | { .fw_name = "main_pll_c2", |
| 59 | .name = "main_pll_c2", }, |
| 60 | { .fw_name = "peri_pll_c2", |
| 61 | .name = "peri_pll_c2", }, |
| 62 | { .fw_name = "osc1", |
| 63 | .name = "osc1", }, |
| 64 | { .fw_name = "cb-intosc-hs-div2-clk", |
| 65 | .name = "cb-intosc-hs-div2-clk", }, |
| 66 | { .fw_name = "f2s-free-clk", |
| 67 | .name = "f2s-free-clk", }, |
| 68 | }; |
| 69 | |
| 70 | static const struct clk_parent_data emacb_free_mux[] = { |
| 71 | { .fw_name = "main_pll_c3", |
| 72 | .name = "main_pll_c3", }, |
| 73 | { .fw_name = "peri_pll_c3", |
| 74 | .name = "peri_pll_c3", }, |
| 75 | { .fw_name = "osc1", |
| 76 | .name = "osc1", }, |
| 77 | { .fw_name = "cb-intosc-hs-div2-clk", |
| 78 | .name = "cb-intosc-hs-div2-clk", }, |
| 79 | { .fw_name = "f2s-free-clk", |
| 80 | .name = "f2s-free-clk", }, |
| 81 | }; |
| 82 | |
| 83 | static const struct clk_parent_data emac_ptp_free_mux[] = { |
| 84 | { .fw_name = "main_pll_c3", |
| 85 | .name = "main_pll_c3", }, |
| 86 | { .fw_name = "peri_pll_c3", |
| 87 | .name = "peri_pll_c3", }, |
| 88 | { .fw_name = "osc1", |
| 89 | .name = "osc1", }, |
| 90 | { .fw_name = "cb-intosc-hs-div2-clk", |
| 91 | .name = "cb-intosc-hs-div2-clk", }, |
| 92 | { .fw_name = "f2s-free-clk", |
| 93 | .name = "f2s-free-clk", }, |
| 94 | }; |
| 95 | |
| 96 | static const struct clk_parent_data gpio_db_free_mux[] = { |
| 97 | { .fw_name = "main_pll_c3", |
| 98 | .name = "main_pll_c3", }, |
| 99 | { .fw_name = "peri_pll_c3", |
| 100 | .name = "peri_pll_c3", }, |
| 101 | { .fw_name = "osc1", |
| 102 | .name = "osc1", }, |
| 103 | { .fw_name = "cb-intosc-hs-div2-clk", |
| 104 | .name = "cb-intosc-hs-div2-clk", }, |
| 105 | { .fw_name = "f2s-free-clk", |
| 106 | .name = "f2s-free-clk", }, |
| 107 | }; |
| 108 | |
| 109 | static const struct clk_parent_data psi_ref_free_mux[] = { |
| 110 | { .fw_name = "main_pll_c3", |
| 111 | .name = "main_pll_c3", }, |
| 112 | { .fw_name = "peri_pll_c3", |
| 113 | .name = "peri_pll_c3", }, |
| 114 | { .fw_name = "osc1", |
| 115 | .name = "osc1", }, |
| 116 | { .fw_name = "cb-intosc-hs-div2-clk", |
| 117 | .name = "cb-intosc-hs-div2-clk", }, |
| 118 | { .fw_name = "f2s-free-clk", |
| 119 | .name = "f2s-free-clk", }, |
| 120 | }; |
| 121 | |
| 122 | static const struct clk_parent_data sdmmc_free_mux[] = { |
| 123 | { .fw_name = "main_pll_c3", |
| 124 | .name = "main_pll_c3", }, |
| 125 | { .fw_name = "peri_pll_c3", |
| 126 | .name = "peri_pll_c3", }, |
| 127 | { .fw_name = "osc1", |
| 128 | .name = "osc1", }, |
| 129 | { .fw_name = "cb-intosc-hs-div2-clk", |
| 130 | .name = "cb-intosc-hs-div2-clk", }, |
| 131 | { .fw_name = "f2s-free-clk", |
| 132 | .name = "f2s-free-clk", }, |
| 133 | }; |
| 134 | |
| 135 | static const struct clk_parent_data s2f_usr0_free_mux[] = { |
| 136 | { .fw_name = "main_pll_c2", |
| 137 | .name = "main_pll_c2", }, |
| 138 | { .fw_name = "peri_pll_c2", |
| 139 | .name = "peri_pll_c2", }, |
| 140 | { .fw_name = "osc1", |
| 141 | .name = "osc1", }, |
| 142 | { .fw_name = "cb-intosc-hs-div2-clk", |
| 143 | .name = "cb-intosc-hs-div2-clk", }, |
| 144 | { .fw_name = "f2s-free-clk", |
| 145 | .name = "f2s-free-clk", }, |
| 146 | }; |
| 147 | |
| 148 | static const struct clk_parent_data s2f_usr1_free_mux[] = { |
| 149 | { .fw_name = "main_pll_c2", |
| 150 | .name = "main_pll_c2", }, |
| 151 | { .fw_name = "peri_pll_c2", |
| 152 | .name = "peri_pll_c2", }, |
| 153 | { .fw_name = "osc1", |
| 154 | .name = "osc1", }, |
| 155 | { .fw_name = "cb-intosc-hs-div2-clk", |
| 156 | .name = "cb-intosc-hs-div2-clk", }, |
| 157 | { .fw_name = "f2s-free-clk", |
| 158 | .name = "f2s-free-clk", }, |
| 159 | }; |
| 160 | |
| 161 | static const struct clk_parent_data mpu_mux[] = { |
| 162 | { .fw_name = "mpu_free_clk", |
| 163 | .name = "mpu_free_clk", }, |
| 164 | { .fw_name = "boot_clk", |
| 165 | .name = "boot_clk", }, |
| 166 | }; |
| 167 | |
| 168 | static const struct clk_parent_data s2f_usr0_mux[] = { |
| 169 | { .fw_name = "f2s-free-clk", |
| 170 | .name = "f2s-free-clk", }, |
| 171 | { .fw_name = "boot_clk", |
| 172 | .name = "boot_clk", }, |
| 173 | }; |
| 174 | |
| 175 | static const struct clk_parent_data emac_mux[] = { |
| 176 | { .fw_name = "emaca_free_clk", |
| 177 | .name = "emaca_free_clk", }, |
| 178 | { .fw_name = "emacb_free_clk", |
| 179 | .name = "emacb_free_clk", }, |
| 180 | }; |
| 181 | |
| 182 | static const struct clk_parent_data noc_mux[] = { |
| 183 | { .fw_name = "noc_free_clk", |
| 184 | .name = "noc_free_clk", }, |
| 185 | { .fw_name = "boot_clk", |
| 186 | .name = "boot_clk", }, |
| 187 | }; |
| 188 | |
| 189 | /* clocks in AO (always on) controller */ |
| 190 | static const struct stratix10_pll_clock agilex_pll_clks[] = { |
| 191 | { AGILEX_BOOT_CLK, "boot_clk", boot_mux, ARRAY_SIZE(boot_mux), 0, |
| 192 | 0x0}, |
| 193 | { AGILEX_MAIN_PLL_CLK, "main_pll", pll_mux, ARRAY_SIZE(pll_mux), |
| 194 | 0, 0x48}, |
| 195 | { AGILEX_PERIPH_PLL_CLK, "periph_pll", pll_mux, ARRAY_SIZE(pll_mux), |
| 196 | 0, 0x9c}, |
| 197 | }; |
| 198 | |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 199 | static const struct n5x_perip_c_clock n5x_main_perip_c_clks[] = { |
| 200 | { AGILEX_MAIN_PLL_C0_CLK, "main_pll_c0", "main_pll", NULL, 1, 0, 0x54, 0}, |
| 201 | { AGILEX_MAIN_PLL_C1_CLK, "main_pll_c1", "main_pll", NULL, 1, 0, 0x54, 8}, |
| 202 | { AGILEX_MAIN_PLL_C2_CLK, "main_pll_c2", "main_pll", NULL, 1, 0, 0x54, 16}, |
| 203 | { AGILEX_MAIN_PLL_C3_CLK, "main_pll_c3", "main_pll", NULL, 1, 0, 0x54, 24}, |
| 204 | { AGILEX_PERIPH_PLL_C0_CLK, "peri_pll_c0", "periph_pll", NULL, 1, 0, 0xA8, 0}, |
| 205 | { AGILEX_PERIPH_PLL_C1_CLK, "peri_pll_c1", "periph_pll", NULL, 1, 0, 0xA8, 8}, |
| 206 | { AGILEX_PERIPH_PLL_C2_CLK, "peri_pll_c2", "periph_pll", NULL, 1, 0, 0xA8, 16}, |
| 207 | { AGILEX_PERIPH_PLL_C3_CLK, "peri_pll_c3", "periph_pll", NULL, 1, 0, 0xA8, 24}, |
| 208 | }; |
| 209 | |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 210 | static const struct stratix10_perip_c_clock agilex_main_perip_c_clks[] = { |
| 211 | { AGILEX_MAIN_PLL_C0_CLK, "main_pll_c0", "main_pll", NULL, 1, 0, 0x58}, |
| 212 | { AGILEX_MAIN_PLL_C1_CLK, "main_pll_c1", "main_pll", NULL, 1, 0, 0x5C}, |
| 213 | { AGILEX_MAIN_PLL_C2_CLK, "main_pll_c2", "main_pll", NULL, 1, 0, 0x64}, |
| 214 | { AGILEX_MAIN_PLL_C3_CLK, "main_pll_c3", "main_pll", NULL, 1, 0, 0x68}, |
| 215 | { AGILEX_PERIPH_PLL_C0_CLK, "peri_pll_c0", "periph_pll", NULL, 1, 0, 0xAC}, |
| 216 | { AGILEX_PERIPH_PLL_C1_CLK, "peri_pll_c1", "periph_pll", NULL, 1, 0, 0xB0}, |
| 217 | { AGILEX_PERIPH_PLL_C2_CLK, "peri_pll_c2", "periph_pll", NULL, 1, 0, 0xB8}, |
| 218 | { AGILEX_PERIPH_PLL_C3_CLK, "peri_pll_c3", "periph_pll", NULL, 1, 0, 0xBC}, |
| 219 | }; |
| 220 | |
| 221 | static const struct stratix10_perip_cnt_clock agilex_main_perip_cnt_clks[] = { |
| 222 | { AGILEX_MPU_FREE_CLK, "mpu_free_clk", NULL, mpu_free_mux, ARRAY_SIZE(mpu_free_mux), |
| 223 | 0, 0x3C, 0, 0, 0}, |
| 224 | { AGILEX_NOC_FREE_CLK, "noc_free_clk", NULL, noc_free_mux, ARRAY_SIZE(noc_free_mux), |
Dinh Nguyen | efbe21d | 2021-06-10 21:51:58 -0500 | [diff] [blame^] | 225 | 0, 0x40, 0, 0, 0}, |
| 226 | { AGILEX_L4_SYS_FREE_CLK, "l4_sys_free_clk", NULL, noc_mux, ARRAY_SIZE(noc_mux), 0, |
| 227 | 0, 4, 0x30, 1}, |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 228 | { AGILEX_EMAC_A_FREE_CLK, "emaca_free_clk", NULL, emaca_free_mux, ARRAY_SIZE(emaca_free_mux), |
| 229 | 0, 0xD4, 0, 0x88, 0}, |
| 230 | { AGILEX_EMAC_B_FREE_CLK, "emacb_free_clk", NULL, emacb_free_mux, ARRAY_SIZE(emacb_free_mux), |
| 231 | 0, 0xD8, 0, 0x88, 1}, |
| 232 | { AGILEX_EMAC_PTP_FREE_CLK, "emac_ptp_free_clk", NULL, emac_ptp_free_mux, |
| 233 | ARRAY_SIZE(emac_ptp_free_mux), 0, 0xDC, 0, 0x88, 2}, |
| 234 | { AGILEX_GPIO_DB_FREE_CLK, "gpio_db_free_clk", NULL, gpio_db_free_mux, |
| 235 | ARRAY_SIZE(gpio_db_free_mux), 0, 0xE0, 0, 0x88, 3}, |
| 236 | { AGILEX_SDMMC_FREE_CLK, "sdmmc_free_clk", NULL, sdmmc_free_mux, |
| 237 | ARRAY_SIZE(sdmmc_free_mux), 0, 0xE4, 0, 0x88, 4}, |
| 238 | { AGILEX_S2F_USER0_FREE_CLK, "s2f_user0_free_clk", NULL, s2f_usr0_free_mux, |
| 239 | ARRAY_SIZE(s2f_usr0_free_mux), 0, 0xE8, 0, 0, 0}, |
| 240 | { AGILEX_S2F_USER1_FREE_CLK, "s2f_user1_free_clk", NULL, s2f_usr1_free_mux, |
| 241 | ARRAY_SIZE(s2f_usr1_free_mux), 0, 0xEC, 0, 0x88, 5}, |
| 242 | { AGILEX_PSI_REF_FREE_CLK, "psi_ref_free_clk", NULL, psi_ref_free_mux, |
| 243 | ARRAY_SIZE(psi_ref_free_mux), 0, 0xF0, 0, 0x88, 6}, |
| 244 | }; |
| 245 | |
| 246 | static const struct stratix10_gate_clock agilex_gate_clks[] = { |
| 247 | { AGILEX_MPU_CLK, "mpu_clk", NULL, mpu_mux, ARRAY_SIZE(mpu_mux), 0, 0x24, |
| 248 | 0, 0, 0, 0, 0x30, 0, 0}, |
| 249 | { AGILEX_MPU_PERIPH_CLK, "mpu_periph_clk", "mpu_clk", NULL, 1, 0, 0x24, |
| 250 | 0, 0, 0, 0, 0, 0, 4}, |
Dinh Nguyen | 44a7f3e | 2020-06-16 15:24:17 -0500 | [diff] [blame] | 251 | { AGILEX_MPU_CCU_CLK, "mpu_ccu_clk", "mpu_clk", NULL, 1, 0, 0x24, |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 252 | 0, 0, 0, 0, 0, 0, 2}, |
Dinh Nguyen | efbe21d | 2021-06-10 21:51:58 -0500 | [diff] [blame^] | 253 | { AGILEX_L4_MAIN_CLK, "l4_main_clk", NULL, noc_mux, ARRAY_SIZE(noc_mux), 0, 0x24, |
| 254 | 1, 0x44, 0, 2, 0x30, 1, 0}, |
| 255 | { AGILEX_L4_MP_CLK, "l4_mp_clk", NULL, noc_mux, ARRAY_SIZE(noc_mux), 0, 0x24, |
| 256 | 2, 0x44, 8, 2, 0x30, 1, 0}, |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 257 | /* |
| 258 | * The l4_sp_clk feeds a 100 MHz clock to various peripherals, one of them |
| 259 | * being the SP timers, thus cannot get gated. |
| 260 | */ |
Dinh Nguyen | efbe21d | 2021-06-10 21:51:58 -0500 | [diff] [blame^] | 261 | { AGILEX_L4_SP_CLK, "l4_sp_clk", NULL, noc_mux, ARRAY_SIZE(noc_mux), CLK_IS_CRITICAL, 0x24, |
| 262 | 3, 0x44, 16, 2, 0x30, 1, 0}, |
| 263 | { AGILEX_CS_AT_CLK, "cs_at_clk", NULL, noc_mux, ARRAY_SIZE(noc_mux), 0, 0x24, |
| 264 | 4, 0x44, 24, 2, 0x30, 1, 0}, |
| 265 | { AGILEX_CS_TRACE_CLK, "cs_trace_clk", NULL, noc_mux, ARRAY_SIZE(noc_mux), 0, 0x24, |
| 266 | 4, 0x44, 26, 2, 0x30, 1, 0}, |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 267 | { AGILEX_CS_PDBG_CLK, "cs_pdbg_clk", "cs_at_clk", NULL, 1, 0, 0x24, |
| 268 | 4, 0x44, 28, 1, 0, 0, 0}, |
Dinh Nguyen | efbe21d | 2021-06-10 21:51:58 -0500 | [diff] [blame^] | 269 | { AGILEX_CS_TIMER_CLK, "cs_timer_clk", NULL, noc_mux, ARRAY_SIZE(noc_mux), 0, 0x24, |
| 270 | 5, 0, 0, 0, 0x30, 1, 0}, |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 271 | { AGILEX_S2F_USER0_CLK, "s2f_user0_clk", NULL, s2f_usr0_mux, ARRAY_SIZE(s2f_usr0_mux), 0, 0x24, |
| 272 | 6, 0, 0, 0, 0, 0, 0}, |
| 273 | { AGILEX_EMAC0_CLK, "emac0_clk", NULL, emac_mux, ARRAY_SIZE(emac_mux), 0, 0x7C, |
| 274 | 0, 0, 0, 0, 0x94, 26, 0}, |
| 275 | { AGILEX_EMAC1_CLK, "emac1_clk", NULL, emac_mux, ARRAY_SIZE(emac_mux), 0, 0x7C, |
| 276 | 1, 0, 0, 0, 0x94, 27, 0}, |
| 277 | { AGILEX_EMAC2_CLK, "emac2_clk", NULL, emac_mux, ARRAY_SIZE(emac_mux), 0, 0x7C, |
| 278 | 2, 0, 0, 0, 0x94, 28, 0}, |
| 279 | { AGILEX_EMAC_PTP_CLK, "emac_ptp_clk", "emac_ptp_free_clk", NULL, 1, 0, 0x7C, |
| 280 | 3, 0, 0, 0, 0, 0, 0}, |
| 281 | { AGILEX_GPIO_DB_CLK, "gpio_db_clk", "gpio_db_free_clk", NULL, 1, 0, 0x7C, |
| 282 | 4, 0x98, 0, 16, 0, 0, 0}, |
| 283 | { AGILEX_SDMMC_CLK, "sdmmc_clk", "sdmmc_free_clk", NULL, 1, 0, 0x7C, |
| 284 | 5, 0, 0, 0, 0, 0, 4}, |
| 285 | { AGILEX_S2F_USER1_CLK, "s2f_user1_clk", "s2f_user1_free_clk", NULL, 1, 0, 0x7C, |
| 286 | 6, 0, 0, 0, 0, 0, 0}, |
| 287 | { AGILEX_PSI_REF_CLK, "psi_ref_clk", "psi_ref_free_clk", NULL, 1, 0, 0x7C, |
| 288 | 7, 0, 0, 0, 0, 0, 0}, |
| 289 | { AGILEX_USB_CLK, "usb_clk", "l4_mp_clk", NULL, 1, 0, 0x7C, |
| 290 | 8, 0, 0, 0, 0, 0, 0}, |
| 291 | { AGILEX_SPI_M_CLK, "spi_m_clk", "l4_mp_clk", NULL, 1, 0, 0x7C, |
| 292 | 9, 0, 0, 0, 0, 0, 0}, |
Dinh Nguyen | 6f3bcf5 | 2020-06-16 15:24:16 -0500 | [diff] [blame] | 293 | { AGILEX_NAND_X_CLK, "nand_x_clk", "l4_mp_clk", NULL, 1, 0, 0x7C, |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 294 | 10, 0, 0, 0, 0, 0, 0}, |
Dinh Nguyen | 6f3bcf5 | 2020-06-16 15:24:16 -0500 | [diff] [blame] | 295 | { AGILEX_NAND_CLK, "nand_clk", "nand_x_clk", NULL, 1, 0, 0x7C, |
| 296 | 10, 0, 0, 0, 0, 0, 4}, |
| 297 | { AGILEX_NAND_ECC_CLK, "nand_ecc_clk", "nand_x_clk", NULL, 1, 0, 0x7C, |
| 298 | 10, 0, 0, 0, 0, 0, 4}, |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 299 | }; |
| 300 | |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 301 | static int n5x_clk_register_c_perip(const struct n5x_perip_c_clock *clks, |
| 302 | int nums, struct stratix10_clock_data *data) |
| 303 | { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 304 | struct clk_hw *hw_clk; |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 305 | void __iomem *base = data->base; |
| 306 | int i; |
| 307 | |
| 308 | for (i = 0; i < nums; i++) { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 309 | hw_clk = n5x_register_periph(&clks[i], base); |
| 310 | if (IS_ERR(hw_clk)) { |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 311 | pr_err("%s: failed to register clock %s\n", |
| 312 | __func__, clks[i].name); |
| 313 | continue; |
| 314 | } |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 315 | data->clk_data.hws[clks[i].id] = hw_clk; |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 316 | } |
| 317 | return 0; |
| 318 | } |
| 319 | |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 320 | static int agilex_clk_register_c_perip(const struct stratix10_perip_c_clock *clks, |
| 321 | int nums, struct stratix10_clock_data *data) |
| 322 | { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 323 | struct clk_hw *hw_clk; |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 324 | void __iomem *base = data->base; |
| 325 | int i; |
| 326 | |
| 327 | for (i = 0; i < nums; i++) { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 328 | hw_clk = s10_register_periph(&clks[i], base); |
| 329 | if (IS_ERR(hw_clk)) { |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 330 | pr_err("%s: failed to register clock %s\n", |
| 331 | __func__, clks[i].name); |
| 332 | continue; |
| 333 | } |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 334 | data->clk_data.hws[clks[i].id] = hw_clk; |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 335 | } |
| 336 | return 0; |
| 337 | } |
| 338 | |
| 339 | static int agilex_clk_register_cnt_perip(const struct stratix10_perip_cnt_clock *clks, |
| 340 | int nums, struct stratix10_clock_data *data) |
| 341 | { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 342 | struct clk_hw *hw_clk; |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 343 | void __iomem *base = data->base; |
| 344 | int i; |
| 345 | |
| 346 | for (i = 0; i < nums; i++) { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 347 | hw_clk = s10_register_cnt_periph(&clks[i], base); |
| 348 | if (IS_ERR(hw_clk)) { |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 349 | pr_err("%s: failed to register clock %s\n", |
| 350 | __func__, clks[i].name); |
| 351 | continue; |
| 352 | } |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 353 | data->clk_data.hws[clks[i].id] = hw_clk; |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 354 | } |
| 355 | |
| 356 | return 0; |
| 357 | } |
| 358 | |
Stephen Boyd | abbe1ef | 2021-03-30 19:27:02 -0700 | [diff] [blame] | 359 | static int agilex_clk_register_gate(const struct stratix10_gate_clock *clks, |
| 360 | int nums, struct stratix10_clock_data *data) |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 361 | { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 362 | struct clk_hw *hw_clk; |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 363 | void __iomem *base = data->base; |
| 364 | int i; |
| 365 | |
| 366 | for (i = 0; i < nums; i++) { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 367 | hw_clk = s10_register_gate(&clks[i], base); |
| 368 | if (IS_ERR(hw_clk)) { |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 369 | pr_err("%s: failed to register clock %s\n", |
| 370 | __func__, clks[i].name); |
| 371 | continue; |
| 372 | } |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 373 | data->clk_data.hws[clks[i].id] = hw_clk; |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 374 | } |
| 375 | |
| 376 | return 0; |
| 377 | } |
| 378 | |
| 379 | static int agilex_clk_register_pll(const struct stratix10_pll_clock *clks, |
| 380 | int nums, struct stratix10_clock_data *data) |
| 381 | { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 382 | struct clk_hw *hw_clk; |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 383 | void __iomem *base = data->base; |
| 384 | int i; |
| 385 | |
| 386 | for (i = 0; i < nums; i++) { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 387 | hw_clk = agilex_register_pll(&clks[i], base); |
| 388 | if (IS_ERR(hw_clk)) { |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 389 | pr_err("%s: failed to register clock %s\n", |
| 390 | __func__, clks[i].name); |
| 391 | continue; |
| 392 | } |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 393 | data->clk_data.hws[clks[i].id] = hw_clk; |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 394 | } |
| 395 | |
| 396 | return 0; |
| 397 | } |
| 398 | |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 399 | static int n5x_clk_register_pll(const struct stratix10_pll_clock *clks, |
| 400 | int nums, struct stratix10_clock_data *data) |
| 401 | { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 402 | struct clk_hw *hw_clk; |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 403 | void __iomem *base = data->base; |
| 404 | int i; |
| 405 | |
| 406 | for (i = 0; i < nums; i++) { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 407 | hw_clk = n5x_register_pll(&clks[i], base); |
| 408 | if (IS_ERR(hw_clk)) { |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 409 | pr_err("%s: failed to register clock %s\n", |
| 410 | __func__, clks[i].name); |
| 411 | continue; |
| 412 | } |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 413 | data->clk_data.hws[clks[i].id] = hw_clk; |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 414 | } |
| 415 | |
| 416 | return 0; |
| 417 | } |
| 418 | |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 419 | static int agilex_clkmgr_init(struct platform_device *pdev) |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 420 | { |
| 421 | struct device_node *np = pdev->dev.of_node; |
| 422 | struct device *dev = &pdev->dev; |
| 423 | struct stratix10_clock_data *clk_data; |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 424 | struct resource *res; |
| 425 | void __iomem *base; |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 426 | int i, num_clks; |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 427 | |
| 428 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 429 | base = devm_ioremap_resource(dev, res); |
| 430 | if (IS_ERR(base)) |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 431 | return PTR_ERR(base); |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 432 | |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 433 | num_clks = AGILEX_NUM_CLKS; |
| 434 | |
| 435 | clk_data = devm_kzalloc(dev, struct_size(clk_data, clk_data.hws, |
| 436 | num_clks), GFP_KERNEL); |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 437 | if (!clk_data) |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 438 | return -ENOMEM; |
| 439 | |
| 440 | for (i = 0; i < num_clks; i++) |
| 441 | clk_data->clk_data.hws[i] = ERR_PTR(-ENOENT); |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 442 | |
| 443 | clk_data->base = base; |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 444 | clk_data->clk_data.num = num_clks; |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 445 | |
| 446 | agilex_clk_register_pll(agilex_pll_clks, ARRAY_SIZE(agilex_pll_clks), clk_data); |
| 447 | |
| 448 | agilex_clk_register_c_perip(agilex_main_perip_c_clks, |
| 449 | ARRAY_SIZE(agilex_main_perip_c_clks), clk_data); |
| 450 | |
| 451 | agilex_clk_register_cnt_perip(agilex_main_perip_cnt_clks, |
| 452 | ARRAY_SIZE(agilex_main_perip_cnt_clks), |
| 453 | clk_data); |
| 454 | |
| 455 | agilex_clk_register_gate(agilex_gate_clks, ARRAY_SIZE(agilex_gate_clks), |
| 456 | clk_data); |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 457 | of_clk_add_hw_provider(np, of_clk_hw_onecell_get, &clk_data->clk_data); |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 458 | return 0; |
| 459 | } |
| 460 | |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 461 | static int n5x_clkmgr_init(struct platform_device *pdev) |
| 462 | { |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 463 | struct device_node *np = pdev->dev.of_node; |
| 464 | struct device *dev = &pdev->dev; |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 465 | struct stratix10_clock_data *clk_data; |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 466 | struct resource *res; |
| 467 | void __iomem *base; |
| 468 | int i, num_clks; |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 469 | |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 470 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 471 | base = devm_ioremap_resource(dev, res); |
| 472 | if (IS_ERR(base)) |
| 473 | return PTR_ERR(base); |
| 474 | |
| 475 | num_clks = AGILEX_NUM_CLKS; |
| 476 | |
| 477 | clk_data = devm_kzalloc(dev, struct_size(clk_data, clk_data.hws, |
| 478 | num_clks), GFP_KERNEL); |
| 479 | if (!clk_data) |
| 480 | return -ENOMEM; |
| 481 | |
| 482 | for (i = 0; i < num_clks; i++) |
| 483 | clk_data->clk_data.hws[i] = ERR_PTR(-ENOENT); |
| 484 | |
| 485 | clk_data->base = base; |
| 486 | clk_data->clk_data.num = num_clks; |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 487 | |
| 488 | n5x_clk_register_pll(agilex_pll_clks, ARRAY_SIZE(agilex_pll_clks), clk_data); |
| 489 | |
| 490 | n5x_clk_register_c_perip(n5x_main_perip_c_clks, |
| 491 | ARRAY_SIZE(n5x_main_perip_c_clks), clk_data); |
| 492 | |
| 493 | agilex_clk_register_cnt_perip(agilex_main_perip_cnt_clks, |
| 494 | ARRAY_SIZE(agilex_main_perip_cnt_clks), |
| 495 | clk_data); |
| 496 | |
| 497 | agilex_clk_register_gate(agilex_gate_clks, ARRAY_SIZE(agilex_gate_clks), |
| 498 | clk_data); |
Dinh Nguyen | ba7e258 | 2021-03-02 15:41:51 -0600 | [diff] [blame] | 499 | of_clk_add_hw_provider(np, of_clk_hw_onecell_get, &clk_data->clk_data); |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 500 | return 0; |
| 501 | } |
| 502 | |
| 503 | static int agilex_clkmgr_probe(struct platform_device *pdev) |
| 504 | { |
| 505 | int (*probe_func)(struct platform_device *init_func); |
| 506 | |
| 507 | probe_func = of_device_get_match_data(&pdev->dev); |
| 508 | if (!probe_func) |
| 509 | return -ENODEV; |
| 510 | return probe_func(pdev); |
| 511 | } |
| 512 | |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 513 | static const struct of_device_id agilex_clkmgr_match_table[] = { |
| 514 | { .compatible = "intel,agilex-clkmgr", |
Dinh Nguyen | a0f9819 | 2021-02-12 08:30:59 -0600 | [diff] [blame] | 515 | .data = agilex_clkmgr_init }, |
| 516 | { .compatible = "intel,easic-n5x-clkmgr", |
| 517 | .data = n5x_clkmgr_init }, |
Dinh Nguyen | 80c6b7a | 2020-05-12 13:16:47 -0500 | [diff] [blame] | 518 | { } |
| 519 | }; |
| 520 | |
| 521 | static struct platform_driver agilex_clkmgr_driver = { |
| 522 | .probe = agilex_clkmgr_probe, |
| 523 | .driver = { |
| 524 | .name = "agilex-clkmgr", |
| 525 | .suppress_bind_attrs = true, |
| 526 | .of_match_table = agilex_clkmgr_match_table, |
| 527 | }, |
| 528 | }; |
| 529 | |
| 530 | static int __init agilex_clk_init(void) |
| 531 | { |
| 532 | return platform_driver_register(&agilex_clkmgr_driver); |
| 533 | } |
| 534 | core_initcall(agilex_clk_init); |