drivers/clk/mediatek/clk-mt7622.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * MediaTek clock driver for MT7622 SoC
   4  *
   5  * Copyright (C) 2019 MediaTek Inc.
   6  * Author: Ryder Lee <ryder.lee@mediatek.com>
   7  */
   8
   9 #include <common.h>
  10 #include <dm.h>
  11 #include <log.h>
  12 #include <asm/arch-mediatek/reset.h>
  13 #include <asm/io.h>
  14 #include <dt-bindings/clock/mt7622-clk.h>
  15 #include <linux/bitops.h>
  16
  17 #include "clk-mtk.h"
  18
  19 #define MT7622_CLKSQ_STB_CON0           0x20
  20 #define MT7622_PLL_ISO_CON0             0x2c
  21 #define MT7622_PLL_FMAX                 (2500UL * MHZ)
  22 #define MT7622_CON0_RST_BAR             BIT(24)
  23
  24 #define MCU_AXI_DIV                     0x640
  25 #define AXI_DIV_MSK                     GENMASK(4, 0)
  26 #define AXI_DIV_SEL(x)                  (x)
  27
  28 #define MCU_BUS_MUX                     0x7c0
  29 #define MCU_BUS_MSK                     GENMASK(10, 9)
  30 #define MCU_BUS_SEL(x)                  ((x) << 9)
  31
  32 /* apmixedsys */
  33 #define PLL(_id, _reg, _pwr_reg, _en_mask, _flags, _pcwbits, _pd_reg,   \
  34             _pd_shift, _pcw_reg, _pcw_shift) {                          \
  35                 .id = _id,                                              \
  36                 .reg = _reg,                                            \
  37                 .pwr_reg = _pwr_reg,                                    \
  38                 .en_mask = _en_mask,                                    \
  39                 .rst_bar_mask = MT7622_CON0_RST_BAR,                    \
  40                 .fmax = MT7622_PLL_FMAX,                                \
  41                 .flags = _flags,                                        \
  42                 .pcwbits = _pcwbits,                                    \
  43                 .pd_reg = _pd_reg,                                      \
  44                 .pd_shift = _pd_shift,                                  \
  45                 .pcw_reg = _pcw_reg,                                    \
  46                 .pcw_shift = _pcw_shift,                                \
  47         }
  48
  49 static const struct mtk_pll_data apmixed_plls[] = {
  50         PLL(CLK_APMIXED_ARMPLL, 0x200, 0x20c, 0x1, 0,
  51             21, 0x204, 24, 0x204, 0),
  52         PLL(CLK_APMIXED_MAINPLL, 0x210, 0x21c, 0x1, HAVE_RST_BAR,
  53             21, 0x214, 24, 0x214, 0),
  54         PLL(CLK_APMIXED_UNIV2PLL, 0x220, 0x22c, 0x1, HAVE_RST_BAR,
  55             7, 0x224, 24, 0x224, 14),
  56         PLL(CLK_APMIXED_ETH1PLL, 0x300, 0x310, 0x1, 0,
  57             21, 0x300, 1, 0x304, 0),
  58         PLL(CLK_APMIXED_ETH2PLL, 0x314, 0x320, 0x1, 0,
  59             21, 0x314, 1, 0x318, 0),
  60         PLL(CLK_APMIXED_AUD1PLL, 0x324, 0x330, 0x1, 0,
  61             31, 0x324, 1, 0x328, 0),
  62         PLL(CLK_APMIXED_AUD2PLL, 0x334, 0x340, 0x1, 0,
  63             31, 0x334, 1, 0x338, 0),
  64         PLL(CLK_APMIXED_TRGPLL, 0x344, 0x354, 0x1, 0,
  65             21, 0x344, 1, 0x348, 0),
  66         PLL(CLK_APMIXED_SGMIPLL, 0x358, 0x368, 0x1, 0,
  67             21, 0x358, 1, 0x35c, 0),
  68 };
  69
  70 /* topckgen */
  71 #define FACTOR0(_id, _parent, _mult, _div)                      \
  72         FACTOR(_id, _parent, _mult, _div, CLK_PARENT_APMIXED)
  73
  74 #define FACTOR1(_id, _parent, _mult, _div)                      \
  75         FACTOR(_id, _parent, _mult, _div, CLK_PARENT_TOPCKGEN)
  76
  77 #define FACTOR2(_id, _parent, _mult, _div)                      \
  78         FACTOR(_id, _parent, _mult, _div, 0)
  79
  80 static const struct mtk_fixed_clk top_fixed_clks[] = {
  81         FIXED_CLK(CLK_TOP_TO_U2_PHY, CLK_XTAL, 31250000),
  82         FIXED_CLK(CLK_TOP_TO_U2_PHY_1P, CLK_XTAL, 31250000),
  83         FIXED_CLK(CLK_TOP_PCIE0_PIPE_EN, CLK_XTAL, 125000000),
  84         FIXED_CLK(CLK_TOP_PCIE1_PIPE_EN, CLK_XTAL, 125000000),
  85         FIXED_CLK(CLK_TOP_SSUSB_TX250M, CLK_XTAL, 250000000),
  86         FIXED_CLK(CLK_TOP_SSUSB_EQ_RX250M, CLK_XTAL, 250000000),
  87         FIXED_CLK(CLK_TOP_SSUSB_CDR_REF, CLK_XTAL, 33333333),
  88         FIXED_CLK(CLK_TOP_SSUSB_CDR_FB, CLK_XTAL, 50000000),
  89         FIXED_CLK(CLK_TOP_SATA_ASIC, CLK_XTAL, 50000000),
  90         FIXED_CLK(CLK_TOP_SATA_RBC, CLK_XTAL, 50000000),
  91 };
  92
  93 static const struct mtk_fixed_factor top_fixed_divs[] = {
  94         FACTOR0(CLK_TOP_TO_USB3_SYS, CLK_APMIXED_ETH1PLL, 1, 4),
  95         FACTOR0(CLK_TOP_P1_1MHZ, CLK_APMIXED_ETH1PLL, 1, 500),
  96         FACTOR0(CLK_TOP_4MHZ, CLK_APMIXED_ETH1PLL, 1, 125),
  97         FACTOR0(CLK_TOP_P0_1MHZ, CLK_APMIXED_ETH1PLL, 1, 500),
  98         FACTOR1(CLK_TOP_TXCLK_SRC_PRE, CLK_TOP_SGMIIPLL_D2, 1, 1),
  99         FACTOR2(CLK_TOP_RTC, CLK_XTAL, 1, 1024),
 100         FACTOR2(CLK_TOP_MEMPLL, CLK_XTAL, 32, 1),
 101         FACTOR1(CLK_TOP_DMPLL, CLK_TOP_MEMPLL, 1, 1),
 102         FACTOR0(CLK_TOP_SYSPLL_D2, CLK_APMIXED_MAINPLL, 1, 2),
 103         FACTOR0(CLK_TOP_SYSPLL1_D2, CLK_APMIXED_MAINPLL, 1, 4),
 104         FACTOR0(CLK_TOP_SYSPLL1_D4, CLK_APMIXED_MAINPLL, 1, 8),
 105         FACTOR0(CLK_TOP_SYSPLL1_D8, CLK_APMIXED_MAINPLL, 1, 16),
 106         FACTOR0(CLK_TOP_SYSPLL2_D4, CLK_APMIXED_MAINPLL, 1, 12),
 107         FACTOR0(CLK_TOP_SYSPLL2_D8, CLK_APMIXED_MAINPLL, 1, 24),
 108         FACTOR0(CLK_TOP_SYSPLL_D5, CLK_APMIXED_MAINPLL, 1, 5),
 109         FACTOR0(CLK_TOP_SYSPLL3_D2, CLK_APMIXED_MAINPLL, 1, 10),
 110         FACTOR0(CLK_TOP_SYSPLL3_D4, CLK_APMIXED_MAINPLL, 1, 20),
 111         FACTOR0(CLK_TOP_SYSPLL4_D2, CLK_APMIXED_MAINPLL, 1, 14),
 112         FACTOR0(CLK_TOP_SYSPLL4_D4, CLK_APMIXED_MAINPLL, 1, 28),
 113         FACTOR0(CLK_TOP_SYSPLL4_D16, CLK_APMIXED_MAINPLL, 1, 112),
 114         FACTOR0(CLK_TOP_UNIVPLL, CLK_APMIXED_UNIV2PLL, 1, 2),
 115         FACTOR0(CLK_TOP_UNIVPLL_D2, CLK_TOP_UNIVPLL, 1, 2),
 116         FACTOR1(CLK_TOP_UNIVPLL1_D2, CLK_TOP_UNIVPLL, 1, 4),
 117         FACTOR1(CLK_TOP_UNIVPLL1_D4, CLK_TOP_UNIVPLL, 1, 8),
 118         FACTOR1(CLK_TOP_UNIVPLL1_D8, CLK_TOP_UNIVPLL, 1, 16),
 119         FACTOR1(CLK_TOP_UNIVPLL1_D16, CLK_TOP_UNIVPLL, 1, 32),
 120         FACTOR1(CLK_TOP_UNIVPLL2_D2, CLK_TOP_UNIVPLL, 1, 6),
 121         FACTOR1(CLK_TOP_UNIVPLL2_D4, CLK_TOP_UNIVPLL, 1, 12),
 122         FACTOR1(CLK_TOP_UNIVPLL2_D8, CLK_TOP_UNIVPLL, 1, 24),
 123         FACTOR1(CLK_TOP_UNIVPLL2_D16, CLK_TOP_UNIVPLL, 1, 48),
 124         FACTOR1(CLK_TOP_UNIVPLL_D5, CLK_TOP_UNIVPLL, 1, 5),
 125         FACTOR1(CLK_TOP_UNIVPLL3_D2, CLK_TOP_UNIVPLL, 1, 10),
 126         FACTOR1(CLK_TOP_UNIVPLL3_D4, CLK_TOP_UNIVPLL, 1, 20),
 127         FACTOR1(CLK_TOP_UNIVPLL3_D16, CLK_TOP_UNIVPLL, 1, 80),
 128         FACTOR1(CLK_TOP_UNIVPLL_D7, CLK_TOP_UNIVPLL, 1, 7),
 129         FACTOR1(CLK_TOP_UNIVPLL_D80_D4, CLK_TOP_UNIVPLL, 1, 320),
 130         FACTOR1(CLK_TOP_UNIV48M, CLK_TOP_UNIVPLL, 1, 25),
 131         FACTOR0(CLK_TOP_SGMIIPLL, CLK_APMIXED_SGMIPLL, 1, 1),
 132         FACTOR0(CLK_TOP_SGMIIPLL_D2, CLK_APMIXED_SGMIPLL, 1, 2),
 133         FACTOR0(CLK_TOP_AUD1PLL, CLK_APMIXED_AUD1PLL, 1, 1),
 134         FACTOR0(CLK_TOP_AUD2PLL, CLK_APMIXED_AUD2PLL, 1, 1),
 135         FACTOR1(CLK_TOP_AUD_I2S2_MCK, CLK_TOP_I2S2_MCK_SEL, 1, 2),
 136         FACTOR1(CLK_TOP_TO_USB3_REF, CLK_TOP_UNIVPLL2_D4, 1, 4),
 137         FACTOR1(CLK_TOP_PCIE1_MAC_EN, CLK_TOP_UNIVPLL1_D4, 1, 1),
 138         FACTOR1(CLK_TOP_PCIE0_MAC_EN, CLK_TOP_UNIVPLL1_D4, 1, 1),
 139         FACTOR0(CLK_TOP_ETH_500M, CLK_APMIXED_ETH1PLL, 1, 1),
 140 };
 141
 142 static const int axi_parents[] = {
 143         CLK_XTAL,
 144         CLK_TOP_SYSPLL1_D2,
 145         CLK_TOP_SYSPLL_D5,
 146         CLK_TOP_SYSPLL1_D4,
 147         CLK_TOP_UNIVPLL_D5,
 148         CLK_TOP_UNIVPLL2_D2,
 149         CLK_TOP_UNIVPLL_D7
 150 };
 151
 152 static const int mem_parents[] = {
 153         CLK_XTAL,
 154         CLK_TOP_DMPLL
 155 };
 156
 157 static const int ddrphycfg_parents[] = {
 158         CLK_XTAL,
 159         CLK_TOP_SYSPLL1_D8
 160 };
 161
 162 static const int eth_parents[] = {
 163         CLK_XTAL,
 164         CLK_TOP_SYSPLL1_D2,
 165         CLK_TOP_UNIVPLL1_D2,
 166         CLK_TOP_SYSPLL1_D4,
 167         CLK_TOP_UNIVPLL_D5,
 168         -1,
 169         CLK_TOP_UNIVPLL_D7
 170 };
 171
 172 static const int pwm_parents[] = {
 173         CLK_XTAL,
 174         CLK_TOP_UNIVPLL2_D4
 175 };
 176
 177 static const int f10m_ref_parents[] = {
 178         CLK_XTAL,
 179         CLK_TOP_SYSPLL4_D16
 180 };
 181
 182 static const int nfi_infra_parents[] = {
 183         CLK_XTAL,
 184         CLK_XTAL,
 185         CLK_XTAL,
 186         CLK_XTAL,
 187         CLK_XTAL,
 188         CLK_XTAL,
 189         CLK_XTAL,
 190         CLK_XTAL,
 191         CLK_TOP_UNIVPLL2_D8,
 192         CLK_TOP_SYSPLL1_D8,
 193         CLK_TOP_UNIVPLL1_D8,
 194         CLK_TOP_SYSPLL4_D2,
 195         CLK_TOP_UNIVPLL2_D4,
 196         CLK_TOP_UNIVPLL3_D2,
 197         CLK_TOP_SYSPLL1_D4
 198 };
 199
 200 static const int flash_parents[] = {
 201         CLK_XTAL,
 202         CLK_TOP_UNIVPLL_D80_D4,
 203         CLK_TOP_SYSPLL2_D8,
 204         CLK_TOP_SYSPLL3_D4,
 205         CLK_TOP_UNIVPLL3_D4,
 206         CLK_TOP_UNIVPLL1_D8,
 207         CLK_TOP_SYSPLL2_D4,
 208         CLK_TOP_UNIVPLL2_D4
 209 };
 210
 211 static const int uart_parents[] = {
 212         CLK_XTAL,
 213         CLK_TOP_UNIVPLL2_D8
 214 };
 215
 216 static const int spi0_parents[] = {
 217         CLK_XTAL,
 218         CLK_TOP_SYSPLL3_D2,
 219         CLK_XTAL,
 220         CLK_TOP_SYSPLL2_D4,
 221         CLK_TOP_SYSPLL4_D2,
 222         CLK_TOP_UNIVPLL2_D4,
 223         CLK_TOP_UNIVPLL1_D8,
 224         CLK_XTAL
 225 };
 226
 227 static const int spi1_parents[] = {
 228         CLK_XTAL,
 229         CLK_TOP_SYSPLL3_D2,
 230         CLK_XTAL,
 231         CLK_TOP_SYSPLL4_D4,
 232         CLK_TOP_SYSPLL4_D2,
 233         CLK_TOP_UNIVPLL2_D4,
 234         CLK_TOP_UNIVPLL1_D8,
 235         CLK_XTAL
 236 };
 237
 238 static const int msdc30_0_parents[] = {
 239         CLK_XTAL,
 240         CLK_TOP_UNIVPLL2_D16,
 241         CLK_TOP_UNIV48M
 242 };
 243
 244 static const int a1sys_hp_parents[] = {
 245         CLK_XTAL,
 246         CLK_TOP_AUD1PLL,
 247         CLK_TOP_AUD2PLL,
 248         CLK_XTAL
 249 };
 250
 251 static const int intdir_parents[] = {
 252         CLK_XTAL,
 253         CLK_TOP_SYSPLL1_D2,
 254         CLK_TOP_UNIVPLL_D2,
 255         CLK_TOP_SGMIIPLL
 256 };
 257
 258 static const int aud_intbus_parents[] = {
 259         CLK_XTAL,
 260         CLK_TOP_SYSPLL1_D4,
 261         CLK_TOP_SYSPLL4_D2,
 262         CLK_TOP_SYSPLL3_D2
 263 };
 264
 265 static const int pmicspi_parents[] = {
 266         CLK_XTAL,
 267         -1,
 268         -1,
 269         -1,
 270         -1,
 271         CLK_TOP_UNIVPLL2_D16
 272 };
 273
 274 static const int atb_parents[] = {
 275         CLK_XTAL,
 276         CLK_TOP_SYSPLL1_D2,
 277         CLK_TOP_SYSPLL_D5
 278 };
 279
 280 static const int audio_parents[] = {
 281         CLK_XTAL,
 282         CLK_TOP_SYSPLL3_D4,
 283         CLK_TOP_SYSPLL4_D4,
 284         CLK_TOP_UNIVPLL1_D16
 285 };
 286
 287 static const int usb20_parents[] = {
 288         CLK_XTAL,
 289         CLK_TOP_UNIVPLL3_D4,
 290         CLK_TOP_SYSPLL1_D8,
 291         CLK_XTAL
 292 };
 293
 294 static const int aud1_parents[] = {
 295         CLK_XTAL,
 296         CLK_TOP_AUD1PLL
 297 };
 298
 299 static const int asm_l_parents[] = {
 300         CLK_XTAL,
 301         CLK_TOP_SYSPLL_D5,
 302         CLK_TOP_UNIVPLL2_D2,
 303         CLK_TOP_UNIVPLL2_D4
 304 };
 305
 306 static const int apll1_ck_parents[] = {
 307         CLK_TOP_AUD1_SEL,
 308         CLK_TOP_AUD2_SEL
 309 };
 310
 311 static const struct mtk_composite top_muxes[] = {
 312         /* CLK_CFG_0 */
 313         MUX_GATE(CLK_TOP_AXI_SEL, axi_parents, 0x40, 0, 3, 7),
 314         MUX_GATE(CLK_TOP_MEM_SEL, mem_parents, 0x40, 8, 1, 15),
 315         MUX_GATE(CLK_TOP_DDRPHYCFG_SEL, ddrphycfg_parents, 0x40, 16, 1, 23),
 316         MUX_GATE(CLK_TOP_ETH_SEL, eth_parents, 0x40, 24, 3, 31),
 317
 318         /* CLK_CFG_1 */
 319         MUX_GATE(CLK_TOP_PWM_SEL, pwm_parents, 0x50, 0, 2, 7),
 320         MUX_GATE(CLK_TOP_F10M_REF_SEL, f10m_ref_parents, 0x50, 8, 1, 15),
 321         MUX_GATE(CLK_TOP_NFI_INFRA_SEL, nfi_infra_parents, 0x50, 16, 4, 23),
 322         MUX_GATE(CLK_TOP_FLASH_SEL, flash_parents, 0x50, 24, 3, 31),
 323
 324         /* CLK_CFG_2 */
 325         MUX_GATE(CLK_TOP_UART_SEL, uart_parents, 0x60, 0, 1, 7),
 326         MUX_GATE(CLK_TOP_SPI0_SEL, spi0_parents, 0x60, 8, 3, 15),
 327         MUX_GATE(CLK_TOP_SPI1_SEL, spi1_parents, 0x60, 16, 3, 23),
 328         MUX_GATE(CLK_TOP_MSDC50_0_SEL, uart_parents, 0x60, 24, 3, 31),
 329
 330         /* CLK_CFG_3 */
 331         MUX_GATE(CLK_TOP_MSDC30_0_SEL, msdc30_0_parents, 0x70, 0, 3, 7),
 332         MUX_GATE(CLK_TOP_MSDC30_1_SEL, msdc30_0_parents, 0x70, 8, 3, 15),
 333         MUX_GATE(CLK_TOP_A1SYS_HP_SEL, a1sys_hp_parents, 0x70, 16, 3, 23),
 334         MUX_GATE(CLK_TOP_A2SYS_HP_SEL, a1sys_hp_parents, 0x70, 24, 3, 31),
 335
 336         /* CLK_CFG_4 */
 337         MUX_GATE(CLK_TOP_INTDIR_SEL, intdir_parents, 0x80, 0, 2, 7),
 338         MUX_GATE(CLK_TOP_AUD_INTBUS_SEL, aud_intbus_parents, 0x80, 8, 2, 15),
 339         MUX_GATE(CLK_TOP_PMICSPI_SEL, pmicspi_parents, 0x80, 16, 3, 23),
 340         MUX_GATE(CLK_TOP_SCP_SEL, ddrphycfg_parents, 0x80, 24, 2, 31),
 341
 342         /* CLK_CFG_5 */
 343         MUX_GATE(CLK_TOP_ATB_SEL, atb_parents, 0x90, 0, 2, 7),
 344         MUX_GATE_FLAGS(CLK_TOP_HIF_SEL, eth_parents, 0x90, 8, 3, 15,
 345                        CLK_DOMAIN_SCPSYS),
 346         MUX_GATE(CLK_TOP_AUDIO_SEL, audio_parents, 0x90, 16, 2, 23),
 347         MUX_GATE(CLK_TOP_U2_SEL, usb20_parents, 0x90, 24, 2, 31),
 348
 349         /* CLK_CFG_6 */
 350         MUX_GATE(CLK_TOP_AUD1_SEL, aud1_parents, 0xA0, 0, 1, 7),
 351         MUX_GATE(CLK_TOP_AUD2_SEL, aud1_parents, 0xA0, 8, 1, 15),
 352         MUX_GATE(CLK_TOP_IRRX_SEL, f10m_ref_parents, 0xA0, 16, 1, 23),
 353         MUX_GATE(CLK_TOP_IRTX_SEL, f10m_ref_parents, 0xA0, 24, 1, 31),
 354
 355         /* CLK_CFG_7 */
 356         MUX_GATE(CLK_TOP_ASM_L_SEL, asm_l_parents, 0xB0, 0, 2, 7),
 357         MUX_GATE(CLK_TOP_ASM_M_SEL, asm_l_parents, 0xB0, 8, 2, 15),
 358         MUX_GATE(CLK_TOP_ASM_H_SEL, asm_l_parents, 0xB0, 16, 2, 23),
 359
 360         /* CLK_AUDDIV_0 */
 361         MUX(CLK_TOP_APLL1_SEL, apll1_ck_parents, 0x120, 6, 1),
 362         MUX(CLK_TOP_APLL2_SEL, apll1_ck_parents, 0x120, 7, 1),
 363         MUX(CLK_TOP_I2S0_MCK_SEL, apll1_ck_parents, 0x120, 8, 1),
 364         MUX(CLK_TOP_I2S1_MCK_SEL, apll1_ck_parents, 0x120, 9, 1),
 365         MUX(CLK_TOP_I2S2_MCK_SEL, apll1_ck_parents, 0x120, 10, 1),
 366         MUX(CLK_TOP_I2S3_MCK_SEL, apll1_ck_parents, 0x120, 161, 1),
 367 };
 368
 369 /* infracfg */
 370 static const struct mtk_gate_regs infra_cg_regs = {
 371         .set_ofs = 0x40,
 372         .clr_ofs = 0x44,
 373         .sta_ofs = 0x48,
 374 };
 375
 376 #define GATE_INFRA(_id, _parent, _shift) {                      \
 377                 .id = _id,                                      \
 378                 .parent = _parent,                              \
 379                 .regs = &infra_cg_regs,                         \
 380                 .shift = _shift,                                \
 381                 .flags = CLK_GATE_SETCLR | CLK_PARENT_TOPCKGEN, \
 382         }
 383
 384 static const struct mtk_gate infra_cgs[] = {
 385         GATE_INFRA(CLK_INFRA_DBGCLK_PD, CLK_TOP_AXI_SEL, 0),
 386         GATE_INFRA(CLK_INFRA_TRNG, CLK_TOP_AXI_SEL, 2),
 387         GATE_INFRA(CLK_INFRA_AUDIO_PD, CLK_TOP_AUD_INTBUS_SEL, 5),
 388         GATE_INFRA(CLK_INFRA_IRRX_PD, CLK_TOP_IRRX_SEL, 16),
 389         GATE_INFRA(CLK_INFRA_APXGPT_PD, CLK_TOP_F10M_REF_SEL, 18),
 390         GATE_INFRA(CLK_INFRA_PMIC_PD, CLK_TOP_PMICSPI_SEL, 22),
 391 };
 392
 393 /* pericfg */
 394 static const struct mtk_gate_regs peri0_cg_regs = {
 395         .set_ofs = 0x8,
 396         .clr_ofs = 0x10,
 397         .sta_ofs = 0x18,
 398 };
 399
 400 static const struct mtk_gate_regs peri1_cg_regs = {
 401         .set_ofs = 0xC,
 402         .clr_ofs = 0x14,
 403         .sta_ofs = 0x1C,
 404 };
 405
 406 #define GATE_PERI0(_id, _parent, _shift) {                      \
 407                 .id = _id,                                      \
 408                 .parent = _parent,                              \
 409                 .regs = &peri0_cg_regs,                         \
 410                 .shift = _shift,                                \
 411                 .flags = CLK_GATE_SETCLR | CLK_PARENT_TOPCKGEN, \
 412         }
 413
 414 #define GATE_PERI1(_id, _parent, _shift) {                      \
 415                 .id = _id,                                      \
 416                 .parent = _parent,                              \
 417                 .regs = &peri1_cg_regs,                         \
 418                 .shift = _shift,                                \
 419                 .flags = CLK_GATE_SETCLR | CLK_PARENT_TOPCKGEN, \
 420         }
 421
 422 static const struct mtk_gate peri_cgs[] = {
 423         /* PERI0 */
 424         GATE_PERI0(CLK_PERI_THERM_PD, CLK_TOP_AXI_SEL, 1),
 425         GATE_PERI0(CLK_PERI_PWM1_PD, CLK_XTAL, 2),
 426         GATE_PERI0(CLK_PERI_PWM2_PD, CLK_XTAL, 3),
 427         GATE_PERI0(CLK_PERI_PWM3_PD, CLK_XTAL, 4),
 428         GATE_PERI0(CLK_PERI_PWM4_PD, CLK_XTAL, 5),
 429         GATE_PERI0(CLK_PERI_PWM5_PD, CLK_XTAL, 6),
 430         GATE_PERI0(CLK_PERI_PWM6_PD, CLK_XTAL, 7),
 431         GATE_PERI0(CLK_PERI_PWM7_PD, CLK_XTAL, 8),
 432         GATE_PERI0(CLK_PERI_PWM_PD, CLK_XTAL, 9),
 433         GATE_PERI0(CLK_PERI_AP_DMA_PD, CLK_TOP_AXI_SEL, 12),
 434         GATE_PERI0(CLK_PERI_MSDC30_0_PD, CLK_TOP_MSDC30_0_SEL, 13),
 435         GATE_PERI0(CLK_PERI_MSDC30_1_PD, CLK_TOP_MSDC30_1_SEL, 14),
 436         GATE_PERI0(CLK_PERI_UART0_PD, CLK_TOP_AXI_SEL, 17),
 437         GATE_PERI0(CLK_PERI_UART1_PD, CLK_TOP_AXI_SEL, 18),
 438         GATE_PERI0(CLK_PERI_UART2_PD, CLK_TOP_AXI_SEL, 19),
 439         GATE_PERI0(CLK_PERI_UART3_PD, CLK_TOP_AXI_SEL, 20),
 440         GATE_PERI0(CLK_PERI_BTIF_PD, CLK_TOP_AXI_SEL, 22),
 441         GATE_PERI0(CLK_PERI_I2C0_PD, CLK_TOP_AXI_SEL, 23),
 442         GATE_PERI0(CLK_PERI_I2C1_PD, CLK_TOP_AXI_SEL, 24),
 443         GATE_PERI0(CLK_PERI_I2C2_PD, CLK_TOP_AXI_SEL, 25),
 444         GATE_PERI0(CLK_PERI_SPI1_PD, CLK_TOP_SPI1_SEL, 26),
 445         GATE_PERI0(CLK_PERI_AUXADC_PD, CLK_XTAL, 27),
 446         GATE_PERI0(CLK_PERI_SPI0_PD, CLK_TOP_SPI0_SEL, 28),
 447         GATE_PERI0(CLK_PERI_SNFI_PD, CLK_TOP_NFI_INFRA_SEL, 29),
 448         GATE_PERI0(CLK_PERI_NFI_PD, CLK_TOP_AXI_SEL, 30),
 449         GATE_PERI1(CLK_PERI_NFIECC_PD, CLK_TOP_AXI_SEL, 31),
 450
 451         /* PERI1 */
 452         GATE_PERI1(CLK_PERI_FLASH_PD, CLK_TOP_FLASH_SEL, 1),
 453         GATE_PERI1(CLK_PERI_IRTX_PD, CLK_TOP_IRTX_SEL, 2),
 454 };
 455
 456 /* ethsys */
 457 static const struct mtk_gate_regs eth_cg_regs = {
 458         .sta_ofs = 0x30,
 459 };
 460
 461 #define GATE_ETH(_id, _parent, _shift) {                        \
 462                 .id = _id,                                      \
 463                 .parent = _parent,                              \
 464                 .regs = &eth_cg_regs,                           \
 465                 .shift = _shift,                                \
 466                 .flags = CLK_GATE_NO_SETCLR_INV | CLK_PARENT_TOPCKGEN,  \
 467         }
 468
 469 static const struct mtk_gate eth_cgs[] = {
 470         GATE_ETH(CLK_ETH_HSDMA_EN, CLK_TOP_ETH_SEL, 5),
 471         GATE_ETH(CLK_ETH_ESW_EN, CLK_TOP_ETH_500M, 6),
 472         GATE_ETH(CLK_ETH_GP2_EN, CLK_TOP_TXCLK_SRC_PRE, 7),
 473         GATE_ETH(CLK_ETH_GP1_EN, CLK_TOP_TXCLK_SRC_PRE, 8),
 474         GATE_ETH(CLK_ETH_GP0_EN, CLK_TOP_TXCLK_SRC_PRE, 9),
 475 };
 476
 477 static const struct mtk_gate_regs sgmii_cg_regs = {
 478         .sta_ofs = 0xE4,
 479 };
 480
 481 #define GATE_SGMII(_id, _parent, _shift) {                      \
 482         .id = _id,                                              \
 483         .parent = _parent,                                      \
 484         .regs = &sgmii_cg_regs,                                 \
 485         .shift = _shift,                                        \
 486         .flags = CLK_GATE_NO_SETCLR_INV | CLK_PARENT_TOPCKGEN,  \
 487 }
 488
 489 static const struct mtk_gate sgmii_cgs[] = {
 490         GATE_SGMII(CLK_SGMII_TX250M_EN, CLK_TOP_SSUSB_TX250M, 2),
 491         GATE_SGMII(CLK_SGMII_RX250M_EN, CLK_TOP_SSUSB_EQ_RX250M, 3),
 492         GATE_SGMII(CLK_SGMII_CDR_REF, CLK_TOP_SSUSB_CDR_REF, 4),
 493         GATE_SGMII(CLK_SGMII_CDR_FB, CLK_TOP_SSUSB_CDR_FB, 5),
 494 };
 495
 496 static const struct mtk_clk_tree mt7622_clk_tree = {
 497         .xtal_rate = 25 * MHZ,
 498         .xtal2_rate = 25 * MHZ,
 499         .fdivs_offs = CLK_TOP_TO_USB3_SYS,
 500         .muxes_offs = CLK_TOP_AXI_SEL,
 501         .plls = apmixed_plls,
 502         .fclks = top_fixed_clks,
 503         .fdivs = top_fixed_divs,
 504         .muxes = top_muxes,
 505 };
 506
 507 static int mt7622_mcucfg_probe(struct udevice *dev)
 508 {
 509         void __iomem *base;
 510
 511         base = dev_read_addr_ptr(dev);
 512         if (!base)
 513                 return -ENOENT;
 514
 515         clrsetbits_le32(base + MCU_AXI_DIV, AXI_DIV_MSK,
 516                         AXI_DIV_SEL(0x12));
 517         clrsetbits_le32(base + MCU_BUS_MUX, MCU_BUS_MSK,
 518                         MCU_BUS_SEL(0x1));
 519
 520         return 0;
 521 }
 522
 523 static int mt7622_apmixedsys_probe(struct udevice *dev)
 524 {
 525         struct mtk_clk_priv *priv = dev_get_priv(dev);
 526         int ret;
 527
 528         ret = mtk_common_clk_init(dev, &mt7622_clk_tree);
 529         if (ret)
 530                 return ret;
 531
 532         /* reduce clock square disable time */
 533         // writel(0x501, priv->base + MT7622_CLKSQ_STB_CON0);
 534         writel(0x98940501, priv->base + MT7622_CLKSQ_STB_CON0);
 535
 536         /* extend pwr/iso control timing to 1us */
 537         writel(0x80008, priv->base + MT7622_PLL_ISO_CON0);
 538
 539         return 0;
 540 }
 541
 542 static int mt7622_topckgen_probe(struct udevice *dev)
 543 {
 544         return mtk_common_clk_init(dev, &mt7622_clk_tree);
 545 }
 546
 547 static int mt7622_infracfg_probe(struct udevice *dev)
 548 {
 549         return mtk_common_clk_gate_init(dev, &mt7622_clk_tree, infra_cgs);
 550 }
 551
 552 static int mt7622_pericfg_probe(struct udevice *dev)
 553 {
 554         return mtk_common_clk_gate_init(dev, &mt7622_clk_tree, peri_cgs);
 555 }
 556
 557 static int mt7622_ethsys_probe(struct udevice *dev)
 558 {
 559         return mtk_common_clk_gate_init(dev, &mt7622_clk_tree, eth_cgs);
 560 }
 561
 562 static int mt7622_ethsys_bind(struct udevice *dev)
 563 {
 564         int ret = 0;
 565
 566 #if CONFIG_IS_ENABLED(RESET_MEDIATEK)
 567         ret = mediatek_reset_bind(dev, ETHSYS_HIFSYS_RST_CTRL_OFS, 1);
 568         if (ret)
 569                 debug("Warning: failed to bind reset controller\n");
 570 #endif
 571
 572         return ret;
 573 }
 574
 575 static int mt7622_sgmiisys_probe(struct udevice *dev)
 576 {
 577         return mtk_common_clk_gate_init(dev, &mt7622_clk_tree, sgmii_cgs);
 578 }
 579
 580 static const struct udevice_id mt7622_apmixed_compat[] = {
 581         { .compatible = "mediatek,mt7622-apmixedsys" },
 582         { }
 583 };
 584
 585 static const struct udevice_id mt7622_topckgen_compat[] = {
 586         { .compatible = "mediatek,mt7622-topckgen" },
 587         { }
 588 };
 589
 590 static const struct udevice_id mt7622_infracfg_compat[] = {
 591         { .compatible = "mediatek,mt7622-infracfg", },
 592         { }
 593 };
 594
 595 static const struct udevice_id mt7622_pericfg_compat[] = {
 596         { .compatible = "mediatek,mt7622-pericfg", },
 597         { }
 598 };
 599
 600 static const struct udevice_id mt7622_ethsys_compat[] = {
 601         { .compatible = "mediatek,mt7622-ethsys", },
 602         { }
 603 };
 604
 605 static const struct udevice_id mt7622_sgmiisys_compat[] = {
 606         { .compatible = "mediatek,mt7622-sgmiisys", },
 607         { }
 608 };
 609
 610 static const struct udevice_id mt7622_mcucfg_compat[] = {
 611         { .compatible = "mediatek,mt7622-mcucfg" },
 612         { }
 613 };
 614
 615 U_BOOT_DRIVER(mtk_mcucfg) = {
 616         .name = "mt7622-mcucfg",
 617         .id = UCLASS_SYSCON,
 618         .of_match = mt7622_mcucfg_compat,
 619         .probe = mt7622_mcucfg_probe,
 620         .flags = DM_FLAG_PRE_RELOC,
 621 };
 622
 623 U_BOOT_DRIVER(mtk_clk_apmixedsys) = {
 624         .name = "mt7622-clock-apmixedsys",
 625         .id = UCLASS_CLK,
 626         .of_match = mt7622_apmixed_compat,
 627         .probe = mt7622_apmixedsys_probe,
 628         .priv_auto_alloc_size = sizeof(struct mtk_clk_priv),
 629         .ops = &mtk_clk_apmixedsys_ops,
 630         .flags = DM_FLAG_PRE_RELOC,
 631 };
 632
 633 U_BOOT_DRIVER(mtk_clk_topckgen) = {
 634         .name = "mt7622-clock-topckgen",
 635         .id = UCLASS_CLK,
 636         .of_match = mt7622_topckgen_compat,
 637         .probe = mt7622_topckgen_probe,
 638         .priv_auto_alloc_size = sizeof(struct mtk_clk_priv),
 639         .ops = &mtk_clk_topckgen_ops,
 640         .flags = DM_FLAG_PRE_RELOC,
 641 };
 642
 643 U_BOOT_DRIVER(mtk_clk_infracfg) = {
 644         .name = "mt7622-clock-infracfg",
 645         .id = UCLASS_CLK,
 646         .of_match = mt7622_infracfg_compat,
 647         .probe = mt7622_infracfg_probe,
 648         .priv_auto_alloc_size = sizeof(struct mtk_cg_priv),
 649         .ops = &mtk_clk_gate_ops,
 650         .flags = DM_FLAG_PRE_RELOC,
 651 };
 652
 653 U_BOOT_DRIVER(mtk_clk_pericfg) = {
 654         .name = "mt7622-clock-pericfg",
 655         .id = UCLASS_CLK,
 656         .of_match = mt7622_pericfg_compat,
 657         .probe = mt7622_pericfg_probe,
 658         .priv_auto_alloc_size = sizeof(struct mtk_cg_priv),
 659         .ops = &mtk_clk_gate_ops,
 660         .flags = DM_FLAG_PRE_RELOC,
 661 };
 662
 663 U_BOOT_DRIVER(mtk_clk_ethsys) = {
 664         .name = "mt7622-clock-ethsys",
 665         .id = UCLASS_CLK,
 666         .of_match = mt7622_ethsys_compat,
 667         .probe = mt7622_ethsys_probe,
 668         .bind = mt7622_ethsys_bind,
 669         .priv_auto_alloc_size = sizeof(struct mtk_cg_priv),
 670         .ops = &mtk_clk_gate_ops,
 671 };
 672
 673 U_BOOT_DRIVER(mtk_clk_sgmiisys) = {
 674         .name = "mt7622-clock-sgmiisys",
 675         .id = UCLASS_CLK,
 676         .of_match = mt7622_sgmiisys_compat,
 677         .probe = mt7622_sgmiisys_probe,
 678         .priv_auto_alloc_size = sizeof(struct mtk_cg_priv),
 679         .ops = &mtk_clk_gate_ops,
 680 };