drivers/clk/mediatek/clk-mt6765.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright (c) 2018 MediaTek Inc.
   4  * Author: Owen Chen <owen.chen@mediatek.com>
   5  */
   6
   7 #include <linux/clk-provider.h>
   8 #include <linux/of.h>
   9 #include <linux/of_address.h>
  10 #include <linux/slab.h>
  11 #include <linux/mfd/syscon.h>
  12 #include <linux/mod_devicetable.h>
  13 #include <linux/platform_device.h>
  14
  15 #include "clk-gate.h"
  16 #include "clk-mtk.h"
  17 #include "clk-mux.h"
  18 #include "clk-pll.h"
  19
  20 #include <dt-bindings/clock/mt6765-clk.h>
  21
  22 /*fmeter div select 4*/
  23 #define _DIV4_ 1
  24
  25 static DEFINE_SPINLOCK(mt6765_clk_lock);
  26
  27 /* Total 12 subsys */
  28 static void __iomem *cksys_base;
  29 static void __iomem *apmixed_base;
  30
  31 /* CKSYS */
  32 #define CLK_SCP_CFG_0           (cksys_base + 0x200)
  33 #define CLK_SCP_CFG_1           (cksys_base + 0x204)
  34
  35 /* CG */
  36 #define AP_PLL_CON3             (apmixed_base + 0x0C)
  37 #define PLLON_CON0              (apmixed_base + 0x44)
  38 #define PLLON_CON1              (apmixed_base + 0x48)
  39
  40 /* clk cfg update */
  41 #define CLK_CFG_0               0x40
  42 #define CLK_CFG_0_SET           0x44
  43 #define CLK_CFG_0_CLR           0x48
  44 #define CLK_CFG_1               0x50
  45 #define CLK_CFG_1_SET           0x54
  46 #define CLK_CFG_1_CLR           0x58
  47 #define CLK_CFG_2               0x60
  48 #define CLK_CFG_2_SET           0x64
  49 #define CLK_CFG_2_CLR           0x68
  50 #define CLK_CFG_3               0x70
  51 #define CLK_CFG_3_SET           0x74
  52 #define CLK_CFG_3_CLR           0x78
  53 #define CLK_CFG_4               0x80
  54 #define CLK_CFG_4_SET           0x84
  55 #define CLK_CFG_4_CLR           0x88
  56 #define CLK_CFG_5               0x90
  57 #define CLK_CFG_5_SET           0x94
  58 #define CLK_CFG_5_CLR           0x98
  59 #define CLK_CFG_6               0xa0
  60 #define CLK_CFG_6_SET           0xa4
  61 #define CLK_CFG_6_CLR           0xa8
  62 #define CLK_CFG_7               0xb0
  63 #define CLK_CFG_7_SET           0xb4
  64 #define CLK_CFG_7_CLR           0xb8
  65 #define CLK_CFG_8               0xc0
  66 #define CLK_CFG_8_SET           0xc4
  67 #define CLK_CFG_8_CLR           0xc8
  68 #define CLK_CFG_9               0xd0
  69 #define CLK_CFG_9_SET           0xd4
  70 #define CLK_CFG_9_CLR           0xd8
  71 #define CLK_CFG_10              0xe0
  72 #define CLK_CFG_10_SET          0xe4
  73 #define CLK_CFG_10_CLR          0xe8
  74 #define CLK_CFG_UPDATE          0x004
  75
  76 static const struct mtk_fixed_clk fixed_clks[] = {
  77         FIXED_CLK(CLK_TOP_F_FRTC, "f_frtc_ck", "clk32k", 32768),
  78         FIXED_CLK(CLK_TOP_CLK26M, "clk_26m_ck", "clk26m", 26000000),
  79         FIXED_CLK(CLK_TOP_DMPLL, "dmpll_ck", NULL, 466000000),
  80 };
  81
  82 static const struct mtk_fixed_factor top_divs[] = {
  83         FACTOR(CLK_TOP_SYSPLL, "syspll_ck", "mainpll", 1, 1),
  84         FACTOR(CLK_TOP_SYSPLL_D2, "syspll_d2", "mainpll", 1, 2),
  85         FACTOR(CLK_TOP_SYSPLL1_D2, "syspll1_d2", "syspll_d2", 1, 2),
  86         FACTOR(CLK_TOP_SYSPLL1_D4, "syspll1_d4", "syspll_d2", 1, 4),
  87         FACTOR(CLK_TOP_SYSPLL1_D8, "syspll1_d8", "syspll_d2", 1, 8),
  88         FACTOR(CLK_TOP_SYSPLL1_D16, "syspll1_d16", "syspll_d2", 1, 16),
  89         FACTOR(CLK_TOP_SYSPLL_D3, "syspll_d3", "mainpll", 1, 3),
  90         FACTOR(CLK_TOP_SYSPLL2_D2, "syspll2_d2", "syspll_d3", 1, 2),
  91         FACTOR(CLK_TOP_SYSPLL2_D4, "syspll2_d4", "syspll_d3", 1, 4),
  92         FACTOR(CLK_TOP_SYSPLL2_D8, "syspll2_d8", "syspll_d3", 1, 8),
  93         FACTOR(CLK_TOP_SYSPLL_D5, "syspll_d5", "mainpll", 1, 5),
  94         FACTOR(CLK_TOP_SYSPLL3_D2, "syspll3_d2", "syspll_d5", 1, 2),
  95         FACTOR(CLK_TOP_SYSPLL3_D4, "syspll3_d4", "syspll_d5", 1, 4),
  96         FACTOR(CLK_TOP_SYSPLL_D7, "syspll_d7", "mainpll", 1, 7),
  97         FACTOR(CLK_TOP_SYSPLL4_D2, "syspll4_d2", "syspll_d7", 1, 2),
  98         FACTOR(CLK_TOP_SYSPLL4_D4, "syspll4_d4", "syspll_d7", 1, 4),
  99         FACTOR(CLK_TOP_UNIVPLL, "univpll", "univ2pll", 1, 2),
 100         FACTOR(CLK_TOP_USB20_192M, "usb20_192m_ck", "univpll", 2, 13),
 101         FACTOR(CLK_TOP_USB20_192M_D4, "usb20_192m_d4", "usb20_192m_ck", 1, 4),
 102         FACTOR(CLK_TOP_USB20_192M_D8, "usb20_192m_d8", "usb20_192m_ck", 1, 8),
 103         FACTOR(CLK_TOP_USB20_192M_D16,
 104                "usb20_192m_d16", "usb20_192m_ck", 1, 16),
 105         FACTOR(CLK_TOP_USB20_192M_D32,
 106                "usb20_192m_d32", "usb20_192m_ck", 1, 32),
 107         FACTOR(CLK_TOP_UNIVPLL_D2, "univpll_d2", "univpll", 1, 2),
 108         FACTOR(CLK_TOP_UNIVPLL1_D2, "univpll1_d2", "univpll_d2", 1, 2),
 109         FACTOR(CLK_TOP_UNIVPLL1_D4, "univpll1_d4", "univpll_d2", 1, 4),
 110         FACTOR(CLK_TOP_UNIVPLL_D3, "univpll_d3", "univpll", 1, 3),
 111         FACTOR(CLK_TOP_UNIVPLL2_D2, "univpll2_d2", "univpll_d3", 1, 2),
 112         FACTOR(CLK_TOP_UNIVPLL2_D4, "univpll2_d4", "univpll_d3", 1, 4),
 113         FACTOR(CLK_TOP_UNIVPLL2_D8, "univpll2_d8", "univpll_d3", 1, 8),
 114         FACTOR(CLK_TOP_UNIVPLL2_D32, "univpll2_d32", "univpll_d3", 1, 32),
 115         FACTOR(CLK_TOP_UNIVPLL_D5, "univpll_d5", "univpll", 1, 5),
 116         FACTOR(CLK_TOP_UNIVPLL3_D2, "univpll3_d2", "univpll_d5", 1, 2),
 117         FACTOR(CLK_TOP_UNIVPLL3_D4, "univpll3_d4", "univpll_d5", 1, 4),
 118         FACTOR(CLK_TOP_MMPLL, "mmpll_ck", "mmpll", 1, 1),
 119         FACTOR(CLK_TOP_MMPLL_D2, "mmpll_d2", "mmpll_ck", 1, 2),
 120         FACTOR(CLK_TOP_MPLL, "mpll_ck", "mpll", 1, 1),
 121         FACTOR(CLK_TOP_DA_MPLL_104M_DIV, "mpll_104m_div", "mpll_ck", 1, 2),
 122         FACTOR(CLK_TOP_DA_MPLL_52M_DIV, "mpll_52m_div", "mpll_ck", 1, 4),
 123         FACTOR(CLK_TOP_MFGPLL, "mfgpll_ck", "mfgpll", 1, 1),
 124         FACTOR(CLK_TOP_MSDCPLL, "msdcpll_ck", "msdcpll", 1, 1),
 125         FACTOR(CLK_TOP_MSDCPLL_D2, "msdcpll_d2", "msdcpll_ck", 1, 2),
 126         FACTOR(CLK_TOP_APLL1, "apll1_ck", "apll1", 1, 1),
 127         FACTOR(CLK_TOP_APLL1_D2, "apll1_d2", "apll1_ck", 1, 2),
 128         FACTOR(CLK_TOP_APLL1_D4, "apll1_d4", "apll1_ck", 1, 4),
 129         FACTOR(CLK_TOP_APLL1_D8, "apll1_d8", "apll1_ck", 1, 8),
 130         FACTOR(CLK_TOP_ULPOSC1, "ulposc1_ck", "ulposc1", 1, 1),
 131         FACTOR(CLK_TOP_ULPOSC1_D2, "ulposc1_d2", "ulposc1_ck", 1, 2),
 132         FACTOR(CLK_TOP_ULPOSC1_D4, "ulposc1_d4", "ulposc1_ck", 1, 4),
 133         FACTOR(CLK_TOP_ULPOSC1_D8, "ulposc1_d8", "ulposc1_ck", 1, 8),
 134         FACTOR(CLK_TOP_ULPOSC1_D16, "ulposc1_d16", "ulposc1_ck", 1, 16),
 135         FACTOR(CLK_TOP_ULPOSC1_D32, "ulposc1_d32", "ulposc1_ck", 1, 32),
 136         FACTOR(CLK_TOP_F_F26M, "f_f26m_ck", "clk_26m_ck", 1, 1),
 137         FACTOR(CLK_TOP_AXI, "axi_ck", "axi_sel", 1, 1),
 138         FACTOR(CLK_TOP_MM, "mm_ck", "mm_sel", 1, 1),
 139         FACTOR(CLK_TOP_SCP, "scp_ck", "scp_sel", 1, 1),
 140         FACTOR(CLK_TOP_MFG, "mfg_ck", "mfg_sel", 1, 1),
 141         FACTOR(CLK_TOP_F_FUART, "f_fuart_ck", "uart_sel", 1, 1),
 142         FACTOR(CLK_TOP_SPI, "spi_ck", "spi_sel", 1, 1),
 143         FACTOR(CLK_TOP_MSDC50_0, "msdc50_0_ck", "msdc50_0_sel", 1, 1),
 144         FACTOR(CLK_TOP_MSDC30_1, "msdc30_1_ck", "msdc30_1_sel", 1, 1),
 145         FACTOR(CLK_TOP_AUDIO, "audio_ck", "audio_sel", 1, 1),
 146         FACTOR(CLK_TOP_AUD_1, "aud_1_ck", "aud_1_sel", 1, 1),
 147         FACTOR(CLK_TOP_AUD_ENGEN1, "aud_engen1_ck", "aud_engen1_sel", 1, 1),
 148         FACTOR(CLK_TOP_F_FDISP_PWM, "f_fdisp_pwm_ck", "disp_pwm_sel", 1, 1),
 149         FACTOR(CLK_TOP_SSPM, "sspm_ck", "sspm_sel", 1, 1),
 150         FACTOR(CLK_TOP_DXCC, "dxcc_ck", "dxcc_sel", 1, 1),
 151         FACTOR(CLK_TOP_I2C, "i2c_ck", "i2c_sel", 1, 1),
 152         FACTOR(CLK_TOP_F_FPWM, "f_fpwm_ck", "pwm_sel", 1, 1),
 153         FACTOR(CLK_TOP_F_FSENINF, "f_fseninf_ck", "seninf_sel", 1, 1),
 154         FACTOR(CLK_TOP_AES_FDE, "aes_fde_ck", "aes_fde_sel", 1, 1),
 155         FACTOR(CLK_TOP_F_BIST2FPC, "f_bist2fpc_ck", "univpll2_d2", 1, 1),
 156         FACTOR(CLK_TOP_ARMPLL_DIVIDER_PLL0, "arm_div_pll0", "syspll_d2", 1, 1),
 157         FACTOR(CLK_TOP_ARMPLL_DIVIDER_PLL1, "arm_div_pll1", "syspll_ck", 1, 1),
 158         FACTOR(CLK_TOP_ARMPLL_DIVIDER_PLL2, "arm_div_pll2", "univpll_d2", 1, 1),
 159         FACTOR(CLK_TOP_DA_USB20_48M_DIV,
 160                "usb20_48m_div", "usb20_192m_d4", 1, 1),
 161         FACTOR(CLK_TOP_DA_UNIV_48M_DIV, "univ_48m_div", "usb20_192m_d4", 1, 1),
 162 };
 163
 164 static const char * const axi_parents[] = {
 165         "clk26m",
 166         "syspll_d7",
 167         "syspll1_d4",
 168         "syspll3_d2"
 169 };
 170
 171 static const char * const mem_parents[] = {
 172         "clk26m",
 173         "dmpll_ck",
 174         "apll1_ck"
 175 };
 176
 177 static const char * const mm_parents[] = {
 178         "clk26m",
 179         "mmpll_ck",
 180         "syspll1_d2",
 181         "syspll_d5",
 182         "syspll1_d4",
 183         "univpll_d5",
 184         "univpll1_d2",
 185         "mmpll_d2"
 186 };
 187
 188 static const char * const scp_parents[] = {
 189         "clk26m",
 190         "syspll4_d2",
 191         "univpll2_d2",
 192         "syspll1_d2",
 193         "univpll1_d2",
 194         "syspll_d3",
 195         "univpll_d3"
 196 };
 197
 198 static const char * const mfg_parents[] = {
 199         "clk26m",
 200         "mfgpll_ck",
 201         "syspll_d3",
 202         "univpll_d3"
 203 };
 204
 205 static const char * const atb_parents[] = {
 206         "clk26m",
 207         "syspll1_d4",
 208         "syspll1_d2"
 209 };
 210
 211 static const char * const camtg_parents[] = {
 212         "clk26m",
 213         "usb20_192m_d8",
 214         "univpll2_d8",
 215         "usb20_192m_d4",
 216         "univpll2_d32",
 217         "usb20_192m_d16",
 218         "usb20_192m_d32"
 219 };
 220
 221 static const char * const uart_parents[] = {
 222         "clk26m",
 223         "univpll2_d8"
 224 };
 225
 226 static const char * const spi_parents[] = {
 227         "clk26m",
 228         "syspll3_d2",
 229         "syspll4_d2",
 230         "syspll2_d4"
 231 };
 232
 233 static const char * const msdc5hclk_parents[] = {
 234         "clk26m",
 235         "syspll1_d2",
 236         "univpll1_d4",
 237         "syspll2_d2"
 238 };
 239
 240 static const char * const msdc50_0_parents[] = {
 241         "clk26m",
 242         "msdcpll_ck",
 243         "syspll2_d2",
 244         "syspll4_d2",
 245         "univpll1_d2",
 246         "syspll1_d2",
 247         "univpll_d5",
 248         "univpll1_d4"
 249 };
 250
 251 static const char * const msdc30_1_parents[] = {
 252         "clk26m",
 253         "msdcpll_d2",
 254         "univpll2_d2",
 255         "syspll2_d2",
 256         "syspll1_d4",
 257         "univpll1_d4",
 258         "usb20_192m_d4",
 259         "syspll2_d4"
 260 };
 261
 262 static const char * const audio_parents[] = {
 263         "clk26m",
 264         "syspll3_d4",
 265         "syspll4_d4",
 266         "syspll1_d16"
 267 };
 268
 269 static const char * const aud_intbus_parents[] = {
 270         "clk26m",
 271         "syspll1_d4",
 272         "syspll4_d2"
 273 };
 274
 275 static const char * const aud_1_parents[] = {
 276         "clk26m",
 277         "apll1_ck"
 278 };
 279
 280 static const char * const aud_engen1_parents[] = {
 281         "clk26m",
 282         "apll1_d2",
 283         "apll1_d4",
 284         "apll1_d8"
 285 };
 286
 287 static const char * const disp_pwm_parents[] = {
 288         "clk26m",
 289         "univpll2_d4",
 290         "ulposc1_d2",
 291         "ulposc1_d8"
 292 };
 293
 294 static const char * const sspm_parents[] = {
 295         "clk26m",
 296         "syspll1_d2",
 297         "syspll_d3"
 298 };
 299
 300 static const char * const dxcc_parents[] = {
 301         "clk26m",
 302         "syspll1_d2",
 303         "syspll1_d4",
 304         "syspll1_d8"
 305 };
 306
 307 static const char * const usb_top_parents[] = {
 308         "clk26m",
 309         "univpll3_d4"
 310 };
 311
 312 static const char * const spm_parents[] = {
 313         "clk26m",
 314         "syspll1_d8"
 315 };
 316
 317 static const char * const i2c_parents[] = {
 318         "clk26m",
 319         "univpll3_d4",
 320         "univpll3_d2",
 321         "syspll1_d8",
 322         "syspll2_d8"
 323 };
 324
 325 static const char * const pwm_parents[] = {
 326         "clk26m",
 327         "univpll3_d4",
 328         "syspll1_d8"
 329 };
 330
 331 static const char * const seninf_parents[] = {
 332         "clk26m",
 333         "univpll1_d4",
 334         "univpll1_d2",
 335         "univpll2_d2"
 336 };
 337
 338 static const char * const aes_fde_parents[] = {
 339         "clk26m",
 340         "msdcpll_ck",
 341         "univpll_d3",
 342         "univpll2_d2",
 343         "univpll1_d2",
 344         "syspll1_d2"
 345 };
 346
 347 static const char * const ulposc_parents[] = {
 348         "clk26m",
 349         "ulposc1_d4",
 350         "ulposc1_d8",
 351         "ulposc1_d16",
 352         "ulposc1_d32"
 353 };
 354
 355 static const char * const camtm_parents[] = {
 356         "clk26m",
 357         "univpll1_d4",
 358         "univpll1_d2",
 359         "univpll2_d2"
 360 };
 361
 362 #define INVALID_UPDATE_REG 0xFFFFFFFF
 363 #define INVALID_UPDATE_SHIFT -1
 364 #define INVALID_MUX_GATE -1
 365
 366 static const struct mtk_mux top_muxes[] = {
 367         /* CLK_CFG_0 */
 368         MUX_GATE_CLR_SET_UPD_FLAGS(CLK_TOP_AXI_SEL, "axi_sel", axi_parents,
 369                               CLK_CFG_0, CLK_CFG_0_SET, CLK_CFG_0_CLR,
 370                               0, 2, 7, CLK_CFG_UPDATE, 0,
 371                               CLK_IS_CRITICAL | CLK_SET_RATE_PARENT),
 372         MUX_GATE_CLR_SET_UPD_FLAGS(CLK_TOP_MEM_SEL, "mem_sel", mem_parents,
 373                               CLK_CFG_0, CLK_CFG_0_SET, CLK_CFG_0_CLR,
 374                               8, 2, 15, CLK_CFG_UPDATE, 1,
 375                               CLK_IS_CRITICAL | CLK_SET_RATE_PARENT),
 376         MUX_GATE_CLR_SET_UPD(CLK_TOP_MM_SEL, "mm_sel", mm_parents, CLK_CFG_0,
 377                         CLK_CFG_0_SET, CLK_CFG_0_CLR, 16, 3, 23,
 378                         CLK_CFG_UPDATE, 2),
 379         MUX_GATE_CLR_SET_UPD(CLK_TOP_SCP_SEL, "scp_sel", scp_parents, CLK_CFG_0,
 380                         CLK_CFG_0_SET, CLK_CFG_0_CLR, 24, 3, 31,
 381                         CLK_CFG_UPDATE, 3),
 382         /* CLK_CFG_1 */
 383         MUX_GATE_CLR_SET_UPD(CLK_TOP_MFG_SEL, "mfg_sel", mfg_parents, CLK_CFG_1,
 384                         CLK_CFG_1_SET, CLK_CFG_1_CLR, 0, 2, 7,
 385                         CLK_CFG_UPDATE, 4),
 386         MUX_GATE_CLR_SET_UPD(CLK_TOP_ATB_SEL, "atb_sel", atb_parents, CLK_CFG_1,
 387                         CLK_CFG_1_SET, CLK_CFG_1_CLR, 8, 2, 15,
 388                         CLK_CFG_UPDATE, 5),
 389         MUX_GATE_CLR_SET_UPD(CLK_TOP_CAMTG_SEL, "camtg_sel",
 390                         camtg_parents, CLK_CFG_1, CLK_CFG_1_SET,
 391                         CLK_CFG_1_CLR, 16, 3, 23, CLK_CFG_UPDATE, 6),
 392         MUX_GATE_CLR_SET_UPD(CLK_TOP_CAMTG1_SEL, "camtg1_sel", camtg_parents,
 393                         CLK_CFG_1, CLK_CFG_1_SET, CLK_CFG_1_CLR,
 394                         24, 3, 31, CLK_CFG_UPDATE, 7),
 395         /* CLK_CFG_2 */
 396         MUX_GATE_CLR_SET_UPD(CLK_TOP_CAMTG2_SEL, "camtg2_sel",
 397                         camtg_parents, CLK_CFG_2, CLK_CFG_2_SET,
 398                         CLK_CFG_2_CLR, 0, 3, 7, CLK_CFG_UPDATE, 8),
 399         MUX_GATE_CLR_SET_UPD(CLK_TOP_CAMTG3_SEL, "camtg3_sel", camtg_parents,
 400                         CLK_CFG_2, CLK_CFG_2_SET, CLK_CFG_2_CLR,
 401                         8, 3, 15, CLK_CFG_UPDATE, 9),
 402         MUX_GATE_CLR_SET_UPD(CLK_TOP_UART_SEL, "uart_sel", uart_parents,
 403                         CLK_CFG_2, CLK_CFG_2_SET, CLK_CFG_2_CLR, 16, 1, 23,
 404                         CLK_CFG_UPDATE, 10),
 405         MUX_GATE_CLR_SET_UPD(CLK_TOP_SPI_SEL, "spi_sel", spi_parents, CLK_CFG_2,
 406                         CLK_CFG_2_SET, CLK_CFG_2_CLR, 24, 2, 31,
 407                         CLK_CFG_UPDATE, 11),
 408         /* CLK_CFG_3 */
 409         MUX_GATE_CLR_SET_UPD_FLAGS(CLK_TOP_MSDC50_0_HCLK_SEL, "msdc5hclk",
 410                         msdc5hclk_parents, CLK_CFG_3, CLK_CFG_3_SET,
 411                         CLK_CFG_3_CLR, 0, 2, 7, CLK_CFG_UPDATE, 12, 0),
 412         MUX_GATE_CLR_SET_UPD_FLAGS(CLK_TOP_MSDC50_0_SEL, "msdc50_0_sel",
 413                         msdc50_0_parents, CLK_CFG_3, CLK_CFG_3_SET,
 414                         CLK_CFG_3_CLR, 8, 3, 15, CLK_CFG_UPDATE, 13, 0),
 415         MUX_GATE_CLR_SET_UPD_FLAGS(CLK_TOP_MSDC30_1_SEL, "msdc30_1_sel",
 416                         msdc30_1_parents, CLK_CFG_3, CLK_CFG_3_SET,
 417                         CLK_CFG_3_CLR, 16, 3, 23, CLK_CFG_UPDATE, 14, 0),
 418         MUX_GATE_CLR_SET_UPD(CLK_TOP_AUDIO_SEL, "audio_sel", audio_parents,
 419                         CLK_CFG_3, CLK_CFG_3_SET, CLK_CFG_3_CLR,
 420                         24, 2, 31, CLK_CFG_UPDATE, 15),
 421         /* CLK_CFG_4 */
 422         MUX_GATE_CLR_SET_UPD(CLK_TOP_AUD_INTBUS_SEL, "aud_intbus_sel",
 423                         aud_intbus_parents, CLK_CFG_4, CLK_CFG_4_SET,
 424                         CLK_CFG_4_CLR, 0, 2, 7, CLK_CFG_UPDATE, 16),
 425         MUX_GATE_CLR_SET_UPD(CLK_TOP_AUD_1_SEL, "aud_1_sel", aud_1_parents,
 426                         CLK_CFG_4, CLK_CFG_4_SET, CLK_CFG_4_CLR,
 427                         8, 1, 15, CLK_CFG_UPDATE, 17),
 428         MUX_GATE_CLR_SET_UPD(CLK_TOP_AUD_ENGEN1_SEL, "aud_engen1_sel",
 429                         aud_engen1_parents, CLK_CFG_4, CLK_CFG_4_SET,
 430                         CLK_CFG_4_CLR, 16, 2, 23, CLK_CFG_UPDATE, 18),
 431         MUX_GATE_CLR_SET_UPD(CLK_TOP_DISP_PWM_SEL, "disp_pwm_sel",
 432                         disp_pwm_parents, CLK_CFG_4, CLK_CFG_4_SET,
 433                         CLK_CFG_4_CLR, 24, 2, 31, CLK_CFG_UPDATE, 19),
 434         /* CLK_CFG_5 */
 435         MUX_GATE_CLR_SET_UPD(CLK_TOP_SSPM_SEL, "sspm_sel", sspm_parents,
 436                         CLK_CFG_5, CLK_CFG_5_SET, CLK_CFG_5_CLR, 0, 2, 7,
 437                         CLK_CFG_UPDATE, 20),
 438         MUX_GATE_CLR_SET_UPD(CLK_TOP_DXCC_SEL, "dxcc_sel", dxcc_parents,
 439                         CLK_CFG_5, CLK_CFG_5_SET, CLK_CFG_5_CLR, 8, 2, 15,
 440                         CLK_CFG_UPDATE, 21),
 441         MUX_GATE_CLR_SET_UPD(CLK_TOP_USB_TOP_SEL, "usb_top_sel",
 442                         usb_top_parents, CLK_CFG_5, CLK_CFG_5_SET,
 443                         CLK_CFG_5_CLR, 16, 1, 23, CLK_CFG_UPDATE, 22),
 444         MUX_GATE_CLR_SET_UPD(CLK_TOP_SPM_SEL, "spm_sel", spm_parents, CLK_CFG_5,
 445                         CLK_CFG_5_SET, CLK_CFG_5_CLR, 24, 1, 31,
 446                         CLK_CFG_UPDATE, 23),
 447         /* CLK_CFG_6 */
 448         MUX_GATE_CLR_SET_UPD(CLK_TOP_I2C_SEL, "i2c_sel", i2c_parents, CLK_CFG_6,
 449                         CLK_CFG_6_SET, CLK_CFG_6_CLR, 0, 3, 7, CLK_CFG_UPDATE,
 450                         24),
 451         MUX_GATE_CLR_SET_UPD(CLK_TOP_PWM_SEL, "pwm_sel", pwm_parents, CLK_CFG_6,
 452                         CLK_CFG_6_SET, CLK_CFG_6_CLR, 8, 2, 15, CLK_CFG_UPDATE,
 453                         25),
 454         MUX_GATE_CLR_SET_UPD(CLK_TOP_SENINF_SEL, "seninf_sel", seninf_parents,
 455                         CLK_CFG_6, CLK_CFG_6_SET, CLK_CFG_6_CLR, 16, 2, 23,
 456                         CLK_CFG_UPDATE, 26),
 457         MUX_GATE_CLR_SET_UPD(CLK_TOP_AES_FDE_SEL, "aes_fde_sel",
 458                         aes_fde_parents, CLK_CFG_6, CLK_CFG_6_SET,
 459                         CLK_CFG_6_CLR, 24, 3, 31, CLK_CFG_UPDATE, 27),
 460         /* CLK_CFG_7 */
 461         MUX_GATE_CLR_SET_UPD_FLAGS(CLK_TOP_PWRAP_ULPOSC_SEL, "ulposc_sel",
 462                               ulposc_parents, CLK_CFG_7, CLK_CFG_7_SET,
 463                               CLK_CFG_7_CLR, 0, 3, 7, CLK_CFG_UPDATE, 28,
 464                               CLK_IS_CRITICAL | CLK_SET_RATE_PARENT),
 465         MUX_GATE_CLR_SET_UPD(CLK_TOP_CAMTM_SEL, "camtm_sel", camtm_parents,
 466                         CLK_CFG_7, CLK_CFG_7_SET, CLK_CFG_7_CLR, 8, 2, 15,
 467                         CLK_CFG_UPDATE, 29),
 468 };
 469
 470 static const struct mtk_gate_regs top0_cg_regs = {
 471         .set_ofs = 0x0,
 472         .clr_ofs = 0x0,
 473         .sta_ofs = 0x0,
 474 };
 475
 476 static const struct mtk_gate_regs top1_cg_regs = {
 477         .set_ofs = 0x104,
 478         .clr_ofs = 0x104,
 479         .sta_ofs = 0x104,
 480 };
 481
 482 static const struct mtk_gate_regs top2_cg_regs = {
 483         .set_ofs = 0x320,
 484         .clr_ofs = 0x320,
 485         .sta_ofs = 0x320,
 486 };
 487
 488 #define GATE_TOP0(_id, _name, _parent, _shift)                          \
 489         GATE_MTK(_id, _name, _parent, &top0_cg_regs, _shift, &mtk_clk_gate_ops_no_setclr)
 490
 491 #define GATE_TOP1(_id, _name, _parent, _shift)                          \
 492         GATE_MTK(_id, _name, _parent, &top1_cg_regs, _shift, &mtk_clk_gate_ops_no_setclr_inv)
 493
 494 #define GATE_TOP2(_id, _name, _parent, _shift)                          \
 495         GATE_MTK(_id, _name, _parent, &top2_cg_regs, _shift, &mtk_clk_gate_ops_no_setclr)
 496
 497 static const struct mtk_gate top_clks[] = {
 498         /* TOP0 */
 499         GATE_TOP0(CLK_TOP_MD_32K, "md_32k", "f_frtc_ck", 8),
 500         GATE_TOP0(CLK_TOP_MD_26M, "md_26m", "f_f26m_ck", 9),
 501         GATE_TOP0(CLK_TOP_MD2_32K, "md2_32k", "f_frtc_ck", 10),
 502         GATE_TOP0(CLK_TOP_MD2_26M, "md2_26m", "f_f26m_ck", 11),
 503         /* TOP1 */
 504         GATE_TOP1(CLK_TOP_ARMPLL_DIVIDER_PLL0_EN,
 505                   "arm_div_pll0_en", "arm_div_pll0", 3),
 506         GATE_TOP1(CLK_TOP_ARMPLL_DIVIDER_PLL1_EN,
 507                   "arm_div_pll1_en", "arm_div_pll1", 4),
 508         GATE_TOP1(CLK_TOP_ARMPLL_DIVIDER_PLL2_EN,
 509                   "arm_div_pll2_en", "arm_div_pll2", 5),
 510         GATE_TOP1(CLK_TOP_FMEM_OCC_DRC_EN, "drc_en", "univpll2_d2", 6),
 511         GATE_TOP1(CLK_TOP_USB20_48M_EN, "usb20_48m_en", "usb20_48m_div", 8),
 512         GATE_TOP1(CLK_TOP_UNIVPLL_48M_EN, "univpll_48m_en", "univ_48m_div", 9),
 513         GATE_TOP1(CLK_TOP_F_UFS_MP_SAP_CFG_EN, "ufs_sap", "f_f26m_ck", 12),
 514         GATE_TOP1(CLK_TOP_F_BIST2FPC_EN, "bist2fpc", "f_bist2fpc_ck", 16),
 515         /* TOP2 */
 516         GATE_TOP2(CLK_TOP_APLL12_DIV0, "apll12_div0", "aud_1_ck", 2),
 517         GATE_TOP2(CLK_TOP_APLL12_DIV1, "apll12_div1", "aud_1_ck", 3),
 518         GATE_TOP2(CLK_TOP_APLL12_DIV2, "apll12_div2", "aud_1_ck", 4),
 519         GATE_TOP2(CLK_TOP_APLL12_DIV3, "apll12_div3", "aud_1_ck", 5),
 520 };
 521
 522 static const struct mtk_gate_regs ifr2_cg_regs = {
 523         .set_ofs = 0x80,
 524         .clr_ofs = 0x84,
 525         .sta_ofs = 0x90,
 526 };
 527
 528 static const struct mtk_gate_regs ifr3_cg_regs = {
 529         .set_ofs = 0x88,
 530         .clr_ofs = 0x8c,
 531         .sta_ofs = 0x94,
 532 };
 533
 534 static const struct mtk_gate_regs ifr4_cg_regs = {
 535         .set_ofs = 0xa4,
 536         .clr_ofs = 0xa8,
 537         .sta_ofs = 0xac,
 538 };
 539
 540 static const struct mtk_gate_regs ifr5_cg_regs = {
 541         .set_ofs = 0xc0,
 542         .clr_ofs = 0xc4,
 543         .sta_ofs = 0xc8,
 544 };
 545
 546 #define GATE_IFR2(_id, _name, _parent, _shift)                          \
 547         GATE_MTK(_id, _name, _parent, &ifr2_cg_regs, _shift, &mtk_clk_gate_ops_setclr)
 548
 549 #define GATE_IFR3(_id, _name, _parent, _shift)                          \
 550         GATE_MTK(_id, _name, _parent, &ifr3_cg_regs, _shift, &mtk_clk_gate_ops_setclr)
 551
 552 #define GATE_IFR4(_id, _name, _parent, _shift)                          \
 553         GATE_MTK(_id, _name, _parent, &ifr4_cg_regs, _shift, &mtk_clk_gate_ops_setclr)
 554
 555 #define GATE_IFR5(_id, _name, _parent, _shift)                          \
 556         GATE_MTK(_id, _name, _parent, &ifr5_cg_regs, _shift, &mtk_clk_gate_ops_setclr)
 557
 558 static const struct mtk_gate ifr_clks[] = {
 559         /* INFRA_TOPAXI */
 560         /* INFRA PERI */
 561         /* INFRA mode 0 */
 562         GATE_IFR2(CLK_IFR_ICUSB, "ifr_icusb", "axi_ck", 8),
 563         GATE_IFR2(CLK_IFR_GCE, "ifr_gce", "axi_ck", 9),
 564         GATE_IFR2(CLK_IFR_THERM, "ifr_therm", "axi_ck", 10),
 565         GATE_IFR2(CLK_IFR_I2C_AP, "ifr_i2c_ap", "i2c_ck", 11),
 566         GATE_IFR2(CLK_IFR_I2C_CCU, "ifr_i2c_ccu", "i2c_ck", 12),
 567         GATE_IFR2(CLK_IFR_I2C_SSPM, "ifr_i2c_sspm", "i2c_ck", 13),
 568         GATE_IFR2(CLK_IFR_I2C_RSV, "ifr_i2c_rsv", "i2c_ck", 14),
 569         GATE_IFR2(CLK_IFR_PWM_HCLK, "ifr_pwm_hclk", "axi_ck", 15),
 570         GATE_IFR2(CLK_IFR_PWM1, "ifr_pwm1", "f_fpwm_ck", 16),
 571         GATE_IFR2(CLK_IFR_PWM2, "ifr_pwm2", "f_fpwm_ck", 17),
 572         GATE_IFR2(CLK_IFR_PWM3, "ifr_pwm3", "f_fpwm_ck", 18),
 573         GATE_IFR2(CLK_IFR_PWM4, "ifr_pwm4", "f_fpwm_ck", 19),
 574         GATE_IFR2(CLK_IFR_PWM5, "ifr_pwm5", "f_fpwm_ck", 20),
 575         GATE_IFR2(CLK_IFR_PWM, "ifr_pwm", "f_fpwm_ck", 21),
 576         GATE_IFR2(CLK_IFR_UART0, "ifr_uart0", "f_fuart_ck", 22),
 577         GATE_IFR2(CLK_IFR_UART1, "ifr_uart1", "f_fuart_ck", 23),
 578         GATE_IFR2(CLK_IFR_GCE_26M, "ifr_gce_26m", "f_f26m_ck", 27),
 579         GATE_IFR2(CLK_IFR_CQ_DMA_FPC, "ifr_dma", "axi_ck", 28),
 580         GATE_IFR2(CLK_IFR_BTIF, "ifr_btif", "axi_ck", 31),
 581         /* INFRA mode 1 */
 582         GATE_IFR3(CLK_IFR_SPI0, "ifr_spi0", "spi_ck", 1),
 583         GATE_IFR3(CLK_IFR_MSDC0, "ifr_msdc0", "msdc5hclk", 2),
 584         GATE_IFR3(CLK_IFR_MSDC1, "ifr_msdc1", "axi_ck", 4),
 585         GATE_IFR3(CLK_IFR_TRNG, "ifr_trng", "axi_ck", 9),
 586         GATE_IFR3(CLK_IFR_AUXADC, "ifr_auxadc", "f_f26m_ck", 10),
 587         GATE_IFR3(CLK_IFR_CCIF1_AP, "ifr_ccif1_ap", "axi_ck", 12),
 588         GATE_IFR3(CLK_IFR_CCIF1_MD, "ifr_ccif1_md", "axi_ck", 13),
 589         GATE_IFR3(CLK_IFR_AUXADC_MD, "ifr_auxadc_md", "f_f26m_ck", 14),
 590         GATE_IFR3(CLK_IFR_AP_DMA, "ifr_ap_dma", "axi_ck", 18),
 591         GATE_IFR3(CLK_IFR_DEVICE_APC, "ifr_dapc", "axi_ck", 20),
 592         GATE_IFR3(CLK_IFR_CCIF_AP, "ifr_ccif_ap", "axi_ck", 23),
 593         GATE_IFR3(CLK_IFR_AUDIO, "ifr_audio", "axi_ck", 25),
 594         GATE_IFR3(CLK_IFR_CCIF_MD, "ifr_ccif_md", "axi_ck", 26),
 595         /* INFRA mode 2 */
 596         GATE_IFR4(CLK_IFR_RG_PWM_FBCLK6, "ifr_pwmfb", "f_f26m_ck", 0),
 597         GATE_IFR4(CLK_IFR_DISP_PWM, "ifr_disp_pwm", "f_fdisp_pwm_ck", 2),
 598         GATE_IFR4(CLK_IFR_CLDMA_BCLK, "ifr_cldmabclk", "axi_ck", 3),
 599         GATE_IFR4(CLK_IFR_AUDIO_26M_BCLK, "ifr_audio26m", "f_f26m_ck", 4),
 600         GATE_IFR4(CLK_IFR_SPI1, "ifr_spi1", "spi_ck", 6),
 601         GATE_IFR4(CLK_IFR_I2C4, "ifr_i2c4", "i2c_ck", 7),
 602         GATE_IFR4(CLK_IFR_SPI2, "ifr_spi2", "spi_ck", 9),
 603         GATE_IFR4(CLK_IFR_SPI3, "ifr_spi3", "spi_ck", 10),
 604         GATE_IFR4(CLK_IFR_I2C5, "ifr_i2c5", "i2c_ck", 18),
 605         GATE_IFR4(CLK_IFR_I2C5_ARBITER, "ifr_i2c5a", "i2c_ck", 19),
 606         GATE_IFR4(CLK_IFR_I2C5_IMM, "ifr_i2c5_imm", "i2c_ck", 20),
 607         GATE_IFR4(CLK_IFR_I2C1_ARBITER, "ifr_i2c1a", "i2c_ck", 21),
 608         GATE_IFR4(CLK_IFR_I2C1_IMM, "ifr_i2c1_imm", "i2c_ck", 22),
 609         GATE_IFR4(CLK_IFR_I2C2_ARBITER, "ifr_i2c2a", "i2c_ck", 23),
 610         GATE_IFR4(CLK_IFR_I2C2_IMM, "ifr_i2c2_imm", "i2c_ck", 24),
 611         GATE_IFR4(CLK_IFR_SPI4, "ifr_spi4", "spi_ck", 25),
 612         GATE_IFR4(CLK_IFR_SPI5, "ifr_spi5", "spi_ck", 26),
 613         GATE_IFR4(CLK_IFR_CQ_DMA, "ifr_cq_dma", "axi_ck", 27),
 614         GATE_IFR4(CLK_IFR_FAES_FDE, "ifr_faes_fde_ck", "aes_fde_ck", 29),
 615         /* INFRA mode 3 */
 616         GATE_IFR5(CLK_IFR_MSDC0_SELF, "ifr_msdc0sf", "msdc50_0_ck", 0),
 617         GATE_IFR5(CLK_IFR_MSDC1_SELF, "ifr_msdc1sf", "msdc50_0_ck", 1),
 618         GATE_IFR5(CLK_IFR_I2C6, "ifr_i2c6", "i2c_ck", 6),
 619         GATE_IFR5(CLK_IFR_AP_MSDC0, "ifr_ap_msdc0", "msdc50_0_ck", 7),
 620         GATE_IFR5(CLK_IFR_MD_MSDC0, "ifr_md_msdc0", "msdc50_0_ck", 8),
 621         GATE_IFR5(CLK_IFR_MSDC0_SRC, "ifr_msdc0_clk", "msdc50_0_ck", 9),
 622         GATE_IFR5(CLK_IFR_MSDC1_SRC, "ifr_msdc1_clk", "msdc30_1_ck", 10),
 623         GATE_IFR5(CLK_IFR_MCU_PM_BCLK, "ifr_mcu_pm_bclk", "axi_ck", 17),
 624         GATE_IFR5(CLK_IFR_CCIF2_AP, "ifr_ccif2_ap", "axi_ck", 18),
 625         GATE_IFR5(CLK_IFR_CCIF2_MD, "ifr_ccif2_md", "axi_ck", 19),
 626         GATE_IFR5(CLK_IFR_CCIF3_AP, "ifr_ccif3_ap", "axi_ck", 20),
 627         GATE_IFR5(CLK_IFR_CCIF3_MD, "ifr_ccif3_md", "axi_ck", 21),
 628 };
 629
 630 /* additional CCF control for mipi26M race condition(disp/camera) */
 631 static const struct mtk_gate_regs apmixed_cg_regs = {
 632         .set_ofs = 0x14,
 633         .clr_ofs = 0x14,
 634         .sta_ofs = 0x14,
 635 };
 636
 637 #define GATE_APMIXED(_id, _name, _parent, _shift)                       \
 638         GATE_MTK(_id, _name, _parent, &apmixed_cg_regs, _shift, &mtk_clk_gate_ops_no_setclr_inv)
 639
 640 static const struct mtk_gate apmixed_clks[] = {
 641         /* AUDIO0 */
 642         GATE_APMIXED(CLK_APMIXED_SSUSB26M, "apmixed_ssusb26m", "f_f26m_ck",
 643                      4),
 644         GATE_APMIXED(CLK_APMIXED_APPLL26M, "apmixed_appll26m", "f_f26m_ck",
 645                      5),
 646         GATE_APMIXED(CLK_APMIXED_MIPIC0_26M, "apmixed_mipic026m", "f_f26m_ck",
 647                      6),
 648         GATE_APMIXED(CLK_APMIXED_MDPLLGP26M, "apmixed_mdpll26m", "f_f26m_ck",
 649                      7),
 650         GATE_APMIXED(CLK_APMIXED_MMSYS_F26M, "apmixed_mmsys26m", "f_f26m_ck",
 651                      8),
 652         GATE_APMIXED(CLK_APMIXED_UFS26M, "apmixed_ufs26m", "f_f26m_ck",
 653                      9),
 654         GATE_APMIXED(CLK_APMIXED_MIPIC1_26M, "apmixed_mipic126m", "f_f26m_ck",
 655                      11),
 656         GATE_APMIXED(CLK_APMIXED_MEMPLL26M, "apmixed_mempll26m", "f_f26m_ck",
 657                      13),
 658         GATE_APMIXED(CLK_APMIXED_CLKSQ_LVPLL_26M, "apmixed_lvpll26m",
 659                      "f_f26m_ck", 14),
 660         GATE_APMIXED(CLK_APMIXED_MIPID0_26M, "apmixed_mipid026m", "f_f26m_ck",
 661                      16),
 662 };
 663
 664 #define MT6765_PLL_FMAX         (3800UL * MHZ)
 665 #define MT6765_PLL_FMIN         (1500UL * MHZ)
 666
 667 #define CON0_MT6765_RST_BAR     BIT(23)
 668
 669 #define PLL_INFO_NULL           (0xFF)
 670
 671 #define PLL_B(_id, _name, _reg, _pwr_reg, _en_mask, _flags, _pcwbits,   \
 672                 _pcwibits, _pd_reg, _pd_shift, _tuner_reg, _tuner_en_reg,\
 673                 _tuner_en_bit, _pcw_reg, _pcw_shift, _div_table) {\
 674                 .id = _id,                                              \
 675                 .name = _name,                                          \
 676                 .reg = _reg,                                            \
 677                 .pwr_reg = _pwr_reg,                                    \
 678                 .en_mask = _en_mask,                                    \
 679                 .flags = _flags,                                        \
 680                 .rst_bar_mask = CON0_MT6765_RST_BAR,                    \
 681                 .fmax = MT6765_PLL_FMAX,                                \
 682                 .fmin = MT6765_PLL_FMIN,                                \
 683                 .pcwbits = _pcwbits,                                    \
 684                 .pcwibits = _pcwibits,                                  \
 685                 .pd_reg = _pd_reg,                                      \
 686                 .pd_shift = _pd_shift,                                  \
 687                 .tuner_reg = _tuner_reg,                                \
 688                 .tuner_en_reg = _tuner_en_reg,                          \
 689                 .tuner_en_bit = _tuner_en_bit,                          \
 690                 .pcw_reg = _pcw_reg,                                    \
 691                 .pcw_shift = _pcw_shift,                                \
 692                 .div_table = _div_table,                                \
 693         }
 694
 695 #define PLL(_id, _name, _reg, _pwr_reg, _en_mask, _flags, _pcwbits,     \
 696                         _pcwibits, _pd_reg, _pd_shift, _tuner_reg,      \
 697                         _tuner_en_reg, _tuner_en_bit, _pcw_reg, \
 698                         _pcw_shift)     \
 699                 PLL_B(_id, _name, _reg, _pwr_reg, _en_mask, _flags,     \
 700                         _pcwbits, _pcwibits, _pd_reg, _pd_shift,        \
 701                         _tuner_reg, _tuner_en_reg, _tuner_en_bit,       \
 702                         _pcw_reg, _pcw_shift, NULL)     \
 703
 704 static const struct mtk_pll_data plls[] = {
 705         PLL(CLK_APMIXED_ARMPLL_L, "armpll_l", 0x021C, 0x0228, 0,
 706             PLL_AO, 22, 8, 0x0220, 24, 0, 0, 0, 0x0220, 0),
 707         PLL(CLK_APMIXED_ARMPLL, "armpll", 0x020C, 0x0218, 0,
 708             PLL_AO, 22, 8, 0x0210, 24, 0, 0, 0, 0x0210, 0),
 709         PLL(CLK_APMIXED_CCIPLL, "ccipll", 0x022C, 0x0238, 0,
 710             PLL_AO, 22, 8, 0x0230, 24, 0, 0, 0, 0x0230, 0),
 711         PLL(CLK_APMIXED_MAINPLL, "mainpll", 0x023C, 0x0248, 0,
 712             (HAVE_RST_BAR | PLL_AO), 22, 8, 0x0240, 24, 0, 0, 0, 0x0240,
 713             0),
 714         PLL(CLK_APMIXED_MFGPLL, "mfgpll", 0x024C, 0x0258, 0,
 715             0, 22, 8, 0x0250, 24, 0, 0, 0, 0x0250, 0),
 716         PLL(CLK_APMIXED_MMPLL, "mmpll", 0x025C, 0x0268, 0,
 717             0, 22, 8, 0x0260, 24, 0, 0, 0, 0x0260, 0),
 718         PLL(CLK_APMIXED_UNIV2PLL, "univ2pll", 0x026C, 0x0278, 0,
 719             HAVE_RST_BAR, 22, 8, 0x0270, 24, 0, 0, 0, 0x0270, 0),
 720         PLL(CLK_APMIXED_MSDCPLL, "msdcpll", 0x027C, 0x0288, 0,
 721             0, 22, 8, 0x0280, 24, 0, 0, 0, 0x0280, 0),
 722         PLL(CLK_APMIXED_APLL1, "apll1", 0x028C, 0x029C, 0,
 723             0, 32, 8, 0x0290, 24, 0x0040, 0x000C, 0, 0x0294, 0),
 724         PLL(CLK_APMIXED_MPLL, "mpll", 0x02A0, 0x02AC, 0,
 725             PLL_AO, 22, 8, 0x02A4, 24, 0, 0, 0, 0x02A4, 0),
 726 };
 727
 728 static int clk_mt6765_apmixed_probe(struct platform_device *pdev)
 729 {
 730         struct clk_hw_onecell_data *clk_data;
 731         int r;
 732         struct device_node *node = pdev->dev.of_node;
 733         void __iomem *base;
 734
 735         base = devm_platform_ioremap_resource(pdev, 0);
 736         if (IS_ERR(base))
 737                 return PTR_ERR(base);
 738
 739         clk_data = mtk_alloc_clk_data(CLK_APMIXED_NR_CLK);
 740
 741         mtk_clk_register_plls(node, plls, ARRAY_SIZE(plls), clk_data);
 742
 743         mtk_clk_register_gates(&pdev->dev, node, apmixed_clks,
 744                                ARRAY_SIZE(apmixed_clks), clk_data);
 745         r = of_clk_add_hw_provider(node, of_clk_hw_onecell_get, clk_data);
 746
 747         if (r)
 748                 pr_err("%s(): could not register clock provider: %d\n",
 749                        __func__, r);
 750
 751         apmixed_base = base;
 752         /* MPLL, CCIPLL, MAINPLL set HW mode, TDCLKSQ, CLKSQ1 */
 753         writel(readl(AP_PLL_CON3) & 0xFFFFFFE1, AP_PLL_CON3);
 754         writel(readl(PLLON_CON0) & 0x01041041, PLLON_CON0);
 755         writel(readl(PLLON_CON1) & 0x01041041, PLLON_CON1);
 756
 757         return r;
 758 }
 759
 760 static int clk_mt6765_top_probe(struct platform_device *pdev)
 761 {
 762         int r;
 763         struct device_node *node = pdev->dev.of_node;
 764         void __iomem *base;
 765         struct clk_hw_onecell_data *clk_data;
 766
 767         base = devm_platform_ioremap_resource(pdev, 0);
 768         if (IS_ERR(base))
 769                 return PTR_ERR(base);
 770
 771         clk_data = mtk_alloc_clk_data(CLK_TOP_NR_CLK);
 772
 773         mtk_clk_register_fixed_clks(fixed_clks, ARRAY_SIZE(fixed_clks),
 774                                     clk_data);
 775         mtk_clk_register_factors(top_divs, ARRAY_SIZE(top_divs),
 776                                  clk_data);
 777         mtk_clk_register_muxes(&pdev->dev, top_muxes,
 778                                ARRAY_SIZE(top_muxes), node,
 779                                &mt6765_clk_lock, clk_data);
 780         mtk_clk_register_gates(&pdev->dev, node, top_clks,
 781                                ARRAY_SIZE(top_clks), clk_data);
 782
 783         r = of_clk_add_hw_provider(node, of_clk_hw_onecell_get, clk_data);
 784
 785         if (r)
 786                 pr_err("%s(): could not register clock provider: %d\n",
 787                        __func__, r);
 788
 789         cksys_base = base;
 790         /* [4]:no need */
 791         writel(readl(CLK_SCP_CFG_0) | 0x3EF, CLK_SCP_CFG_0);
 792         /*[1,2,3,8]: no need*/
 793         writel(readl(CLK_SCP_CFG_1) | 0x1, CLK_SCP_CFG_1);
 794
 795         return r;
 796 }
 797
 798 static int clk_mt6765_ifr_probe(struct platform_device *pdev)
 799 {
 800         struct clk_hw_onecell_data *clk_data;
 801         int r;
 802         struct device_node *node = pdev->dev.of_node;
 803         void __iomem *base;
 804
 805         base = devm_platform_ioremap_resource(pdev, 0);
 806         if (IS_ERR(base))
 807                 return PTR_ERR(base);
 808
 809         clk_data = mtk_alloc_clk_data(CLK_IFR_NR_CLK);
 810
 811         mtk_clk_register_gates(&pdev->dev, node, ifr_clks,
 812                                ARRAY_SIZE(ifr_clks), clk_data);
 813         r = of_clk_add_hw_provider(node, of_clk_hw_onecell_get, clk_data);
 814
 815         if (r)
 816                 pr_err("%s(): could not register clock provider: %d\n",
 817                        __func__, r);
 818
 819         return r;
 820 }
 821
 822 static const struct of_device_id of_match_clk_mt6765[] = {
 823         {
 824                 .compatible = "mediatek,mt6765-apmixedsys",
 825                 .data = clk_mt6765_apmixed_probe,
 826         }, {
 827                 .compatible = "mediatek,mt6765-topckgen",
 828                 .data = clk_mt6765_top_probe,
 829         }, {
 830                 .compatible = "mediatek,mt6765-infracfg",
 831                 .data = clk_mt6765_ifr_probe,
 832         }, {
 833                 /* sentinel */
 834         }
 835 };
 836 MODULE_DEVICE_TABLE(of, of_match_clk_mt6765);
 837
 838 static int clk_mt6765_probe(struct platform_device *pdev)
 839 {
 840         int (*clk_probe)(struct platform_device *d);
 841         int r;
 842
 843         clk_probe = of_device_get_match_data(&pdev->dev);
 844         if (!clk_probe)
 845                 return -EINVAL;
 846
 847         r = clk_probe(pdev);
 848         if (r)
 849                 dev_err(&pdev->dev,
 850                         "could not register clock provider: %s: %d\n",
 851                         pdev->name, r);
 852
 853         return r;
 854 }
 855
 856 static struct platform_driver clk_mt6765_drv = {
 857         .probe = clk_mt6765_probe,
 858         .driver = {
 859                 .name = "clk-mt6765",
 860                 .of_match_table = of_match_clk_mt6765,
 861         },
 862 };
 863
 864 static int __init clk_mt6765_init(void)
 865 {
 866         return platform_driver_register(&clk_mt6765_drv);
 867 }
 868
 869 arch_initcall(clk_mt6765_init);
 870 MODULE_LICENSE("GPL");