drivers/clk/sirf/clk-common.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * common clks module for all SiRF SoCs
   4  *
   5  * Copyright (c) 2011 - 2014 Cambridge Silicon Radio Limited, a CSR plc group
   6  * company.
   7  */
   8
   9 #include <linux/clk.h>
  10
  11 #define KHZ     1000
  12 #define MHZ     (KHZ * KHZ)
  13
  14 static void __iomem *sirfsoc_clk_vbase;
  15 static void __iomem *sirfsoc_rsc_vbase;
  16 static struct clk_onecell_data clk_data;
  17
  18 /*
  19  * SiRFprimaII clock controller
  20  * - 2 oscillators: osc-26MHz, rtc-32.768KHz
  21  * - 3 standard configurable plls: pll1, pll2 & pll3
  22  * - 2 exclusive plls: usb phy pll and sata phy pll
  23  * - 8 clock domains: cpu/cpudiv, mem/memdiv, sys/io, dsp, graphic, multimedia,
  24  *     display and sdphy.
  25  *     Each clock domain can select its own clock source from five clock sources,
  26  *     X_XIN, X_XINW, PLL1, PLL2 and PLL3. The domain clock is used as the source
  27  *     clock of the group clock.
  28  *     - dsp domain: gps, mf
  29  *     - io domain: dmac, nand, audio, uart, i2c, spi, usp, pwm, pulse
  30  *     - sys domain: security
  31  */
  32
  33 struct clk_pll {
  34         struct clk_hw hw;
  35         unsigned short regofs;  /* register offset */
  36 };
  37
  38 #define to_pllclk(_hw) container_of(_hw, struct clk_pll, hw)
  39
  40 struct clk_dmn {
  41         struct clk_hw hw;
  42         signed char enable_bit; /* enable bit: 0 ~ 63 */
  43         unsigned short regofs;  /* register offset */
  44 };
  45
  46 #define to_dmnclk(_hw) container_of(_hw, struct clk_dmn, hw)
  47
  48 struct clk_std {
  49         struct clk_hw hw;
  50         signed char enable_bit; /* enable bit: 0 ~ 63 */
  51 };
  52
  53 #define to_stdclk(_hw) container_of(_hw, struct clk_std, hw)
  54
  55 static int std_clk_is_enabled(struct clk_hw *hw);
  56 static int std_clk_enable(struct clk_hw *hw);
  57 static void std_clk_disable(struct clk_hw *hw);
  58
  59 static inline unsigned long clkc_readl(unsigned reg)
  60 {
  61         return readl(sirfsoc_clk_vbase + reg);
  62 }
  63
  64 static inline void clkc_writel(u32 val, unsigned reg)
  65 {
  66         writel(val, sirfsoc_clk_vbase + reg);
  67 }
  68
  69 /*
  70  * std pll
  71  */
  72
  73 static unsigned long pll_clk_recalc_rate(struct clk_hw *hw,
  74         unsigned long parent_rate)
  75 {
  76         unsigned long fin = parent_rate;
  77         struct clk_pll *clk = to_pllclk(hw);
  78         u32 regcfg2 = clk->regofs + SIRFSOC_CLKC_PLL1_CFG2 -
  79                 SIRFSOC_CLKC_PLL1_CFG0;
  80
  81         if (clkc_readl(regcfg2) & BIT(2)) {
  82                 /* pll bypass mode */
  83                 return fin;
  84         } else {
  85                 /* fout = fin * nf / nr / od */
  86                 u32 cfg0 = clkc_readl(clk->regofs);
  87                 u32 nf = (cfg0 & (BIT(13) - 1)) + 1;
  88                 u32 nr = ((cfg0 >> 13) & (BIT(6) - 1)) + 1;
  89                 u32 od = ((cfg0 >> 19) & (BIT(4) - 1)) + 1;
  90                 WARN_ON(fin % MHZ);
  91                 return fin / MHZ * nf / nr / od * MHZ;
  92         }
  93 }
  94
  95 static long pll_clk_round_rate(struct clk_hw *hw, unsigned long rate,
  96         unsigned long *parent_rate)
  97 {
  98         unsigned long fin, nf, nr, od;
  99         u64 dividend;
 100
 101         /*
 102          * fout = fin * nf / (nr * od);
 103          * set od = 1, nr = fin/MHz, so fout = nf * MHz
 104          */
 105         rate = rate - rate % MHZ;
 106
 107         nf = rate / MHZ;
 108         if (nf > BIT(13))
 109                 nf = BIT(13);
 110         if (nf < 1)
 111                 nf = 1;
 112
 113         fin = *parent_rate;
 114
 115         nr = fin / MHZ;
 116         if (nr > BIT(6))
 117                 nr = BIT(6);
 118         od = 1;
 119
 120         dividend = (u64)fin * nf;
 121         do_div(dividend, nr * od);
 122
 123         return (long)dividend;
 124 }
 125
 126 static int pll_clk_set_rate(struct clk_hw *hw, unsigned long rate,
 127         unsigned long parent_rate)
 128 {
 129         struct clk_pll *clk = to_pllclk(hw);
 130         unsigned long fin, nf, nr, od, reg;
 131
 132         /*
 133          * fout = fin * nf / (nr * od);
 134          * set od = 1, nr = fin/MHz, so fout = nf * MHz
 135          */
 136
 137         nf = rate / MHZ;
 138         if (unlikely((rate % MHZ) || nf > BIT(13) || nf < 1))
 139                 return -EINVAL;
 140
 141         fin = parent_rate;
 142         BUG_ON(fin < MHZ);
 143
 144         nr = fin / MHZ;
 145         BUG_ON((fin % MHZ) || nr > BIT(6));
 146
 147         od = 1;
 148
 149         reg = (nf - 1) | ((nr - 1) << 13) | ((od - 1) << 19);
 150         clkc_writel(reg, clk->regofs);
 151
 152         reg = clk->regofs + SIRFSOC_CLKC_PLL1_CFG1 - SIRFSOC_CLKC_PLL1_CFG0;
 153         clkc_writel((nf >> 1) - 1, reg);
 154
 155         reg = clk->regofs + SIRFSOC_CLKC_PLL1_CFG2 - SIRFSOC_CLKC_PLL1_CFG0;
 156         while (!(clkc_readl(reg) & BIT(6)))
 157                 cpu_relax();
 158
 159         return 0;
 160 }
 161
 162 static long cpu_clk_round_rate(struct clk_hw *hw, unsigned long rate,
 163         unsigned long *parent_rate)
 164 {
 165         /*
 166          * SiRF SoC has not cpu clock control,
 167          * So bypass to it's parent pll.
 168          */
 169         struct clk_hw *parent_clk = clk_hw_get_parent(hw);
 170         struct clk_hw *pll_parent_clk = clk_hw_get_parent(parent_clk);
 171         unsigned long pll_parent_rate = clk_hw_get_rate(pll_parent_clk);
 172         return pll_clk_round_rate(parent_clk, rate, &pll_parent_rate);
 173 }
 174
 175 static unsigned long cpu_clk_recalc_rate(struct clk_hw *hw,
 176         unsigned long parent_rate)
 177 {
 178         /*
 179          * SiRF SoC has not cpu clock control,
 180          * So return the parent pll rate.
 181          */
 182         struct clk_hw *parent_clk = clk_hw_get_parent(hw);
 183         return clk_hw_get_rate(parent_clk);
 184 }
 185
 186 static const struct clk_ops std_pll_ops = {
 187         .recalc_rate = pll_clk_recalc_rate,
 188         .round_rate = pll_clk_round_rate,
 189         .set_rate = pll_clk_set_rate,
 190 };
 191
 192 static const char * const pll_clk_parents[] = {
 193         "osc",
 194 };
 195
 196 static const struct clk_init_data clk_pll1_init = {
 197         .name = "pll1",
 198         .ops = &std_pll_ops,
 199         .parent_names = pll_clk_parents,
 200         .num_parents = ARRAY_SIZE(pll_clk_parents),
 201 };
 202
 203 static const struct clk_init_data clk_pll2_init = {
 204         .name = "pll2",
 205         .ops = &std_pll_ops,
 206         .parent_names = pll_clk_parents,
 207         .num_parents = ARRAY_SIZE(pll_clk_parents),
 208 };
 209
 210 static const struct clk_init_data clk_pll3_init = {
 211         .name = "pll3",
 212         .ops = &std_pll_ops,
 213         .parent_names = pll_clk_parents,
 214         .num_parents = ARRAY_SIZE(pll_clk_parents),
 215 };
 216
 217 static struct clk_pll clk_pll1 = {
 218         .regofs = SIRFSOC_CLKC_PLL1_CFG0,
 219         .hw = {
 220                 .init = &clk_pll1_init,
 221         },
 222 };
 223
 224 static struct clk_pll clk_pll2 = {
 225         .regofs = SIRFSOC_CLKC_PLL2_CFG0,
 226         .hw = {
 227                 .init = &clk_pll2_init,
 228         },
 229 };
 230
 231 static struct clk_pll clk_pll3 = {
 232         .regofs = SIRFSOC_CLKC_PLL3_CFG0,
 233         .hw = {
 234                 .init = &clk_pll3_init,
 235         },
 236 };
 237
 238 /*
 239  * usb uses specified pll
 240  */
 241
 242 static int usb_pll_clk_enable(struct clk_hw *hw)
 243 {
 244         u32 reg = readl(sirfsoc_rsc_vbase + SIRFSOC_USBPHY_PLL_CTRL);
 245         reg &= ~(SIRFSOC_USBPHY_PLL_POWERDOWN | SIRFSOC_USBPHY_PLL_BYPASS);
 246         writel(reg, sirfsoc_rsc_vbase + SIRFSOC_USBPHY_PLL_CTRL);
 247         while (!(readl(sirfsoc_rsc_vbase + SIRFSOC_USBPHY_PLL_CTRL) &
 248                         SIRFSOC_USBPHY_PLL_LOCK))
 249                 cpu_relax();
 250
 251         return 0;
 252 }
 253
 254 static void usb_pll_clk_disable(struct clk_hw *clk)
 255 {
 256         u32 reg = readl(sirfsoc_rsc_vbase + SIRFSOC_USBPHY_PLL_CTRL);
 257         reg |= (SIRFSOC_USBPHY_PLL_POWERDOWN | SIRFSOC_USBPHY_PLL_BYPASS);
 258         writel(reg, sirfsoc_rsc_vbase + SIRFSOC_USBPHY_PLL_CTRL);
 259 }
 260
 261 static unsigned long usb_pll_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate)
 262 {
 263         u32 reg = readl(sirfsoc_rsc_vbase + SIRFSOC_USBPHY_PLL_CTRL);
 264         return (reg & SIRFSOC_USBPHY_PLL_BYPASS) ? parent_rate : 48*MHZ;
 265 }
 266
 267 static const struct clk_ops usb_pll_ops = {
 268         .enable = usb_pll_clk_enable,
 269         .disable = usb_pll_clk_disable,
 270         .recalc_rate = usb_pll_clk_recalc_rate,
 271 };
 272
 273 static const struct clk_init_data clk_usb_pll_init = {
 274         .name = "usb_pll",
 275         .ops = &usb_pll_ops,
 276         .parent_names = pll_clk_parents,
 277         .num_parents = ARRAY_SIZE(pll_clk_parents),
 278 };
 279
 280 static struct clk_hw usb_pll_clk_hw = {
 281         .init = &clk_usb_pll_init,
 282 };
 283
 284 /*
 285  * clock domains - cpu, mem, sys/io, dsp, gfx
 286  */
 287
 288 static const char * const dmn_clk_parents[] = {
 289         "rtc",
 290         "osc",
 291         "pll1",
 292         "pll2",
 293         "pll3",
 294 };
 295
 296 static u8 dmn_clk_get_parent(struct clk_hw *hw)
 297 {
 298         struct clk_dmn *clk = to_dmnclk(hw);
 299         u32 cfg = clkc_readl(clk->regofs);
 300         const char *name = clk_hw_get_name(hw);
 301
 302         /* parent of io domain can only be pll3 */
 303         if (strcmp(name, "io") == 0)
 304                 return 4;
 305
 306         WARN_ON((cfg & (BIT(3) - 1)) > 4);
 307
 308         return cfg & (BIT(3) - 1);
 309 }
 310
 311 static int dmn_clk_set_parent(struct clk_hw *hw, u8 parent)
 312 {
 313         struct clk_dmn *clk = to_dmnclk(hw);
 314         u32 cfg = clkc_readl(clk->regofs);
 315         const char *name = clk_hw_get_name(hw);
 316
 317         /* parent of io domain can only be pll3 */
 318         if (strcmp(name, "io") == 0)
 319                 return -EINVAL;
 320
 321         cfg &= ~(BIT(3) - 1);
 322         clkc_writel(cfg | parent, clk->regofs);
 323         /* BIT(3) - switching status: 1 - busy, 0 - done */
 324         while (clkc_readl(clk->regofs) & BIT(3))
 325                 cpu_relax();
 326
 327         return 0;
 328 }
 329
 330 static unsigned long dmn_clk_recalc_rate(struct clk_hw *hw,
 331         unsigned long parent_rate)
 332
 333 {
 334         unsigned long fin = parent_rate;
 335         struct clk_dmn *clk = to_dmnclk(hw);
 336
 337         u32 cfg = clkc_readl(clk->regofs);
 338
 339         if (cfg & BIT(24)) {
 340                 /* fcd bypass mode */
 341                 return fin;
 342         } else {
 343                 /*
 344                  * wait count: bit[19:16], hold count: bit[23:20]
 345                  */
 346                 u32 wait = (cfg >> 16) & (BIT(4) - 1);
 347                 u32 hold = (cfg >> 20) & (BIT(4) - 1);
 348
 349                 return fin / (wait + hold + 2);
 350         }
 351 }
 352
 353 static long dmn_clk_round_rate(struct clk_hw *hw, unsigned long rate,
 354         unsigned long *parent_rate)
 355 {
 356         unsigned long fin;
 357         unsigned ratio, wait, hold;
 358         const char *name = clk_hw_get_name(hw);
 359         unsigned bits = (strcmp(name, "mem") == 0) ? 3 : 4;
 360
 361         fin = *parent_rate;
 362         ratio = fin / rate;
 363
 364         if (ratio < 2)
 365                 ratio = 2;
 366         if (ratio > BIT(bits + 1))
 367                 ratio = BIT(bits + 1);
 368
 369         wait = (ratio >> 1) - 1;
 370         hold = ratio - wait - 2;
 371
 372         return fin / (wait + hold + 2);
 373 }
 374
 375 static int dmn_clk_set_rate(struct clk_hw *hw, unsigned long rate,
 376         unsigned long parent_rate)
 377 {
 378         struct clk_dmn *clk = to_dmnclk(hw);
 379         unsigned long fin;
 380         unsigned ratio, wait, hold, reg;
 381         const char *name = clk_hw_get_name(hw);
 382         unsigned bits = (strcmp(name, "mem") == 0) ? 3 : 4;
 383
 384         fin = parent_rate;
 385         ratio = fin / rate;
 386
 387         if (unlikely(ratio < 2 || ratio > BIT(bits + 1)))
 388                 return -EINVAL;
 389
 390         WARN_ON(fin % rate);
 391
 392         wait = (ratio >> 1) - 1;
 393         hold = ratio - wait - 2;
 394
 395         reg = clkc_readl(clk->regofs);
 396         reg &= ~(((BIT(bits) - 1) << 16) | ((BIT(bits) - 1) << 20));
 397         reg |= (wait << 16) | (hold << 20) | BIT(25);
 398         clkc_writel(reg, clk->regofs);
 399
 400         /* waiting FCD been effective */
 401         while (clkc_readl(clk->regofs) & BIT(25))
 402                 cpu_relax();
 403
 404         return 0;
 405 }
 406
 407 static int cpu_clk_set_rate(struct clk_hw *hw, unsigned long rate,
 408                 unsigned long parent_rate)
 409 {
 410         int ret1, ret2;
 411         struct clk *cur_parent;
 412
 413         if (rate == clk_get_rate(clk_pll1.hw.clk)) {
 414                 ret1 = clk_set_parent(hw->clk, clk_pll1.hw.clk);
 415                 return ret1;
 416         }
 417
 418         if (rate == clk_get_rate(clk_pll2.hw.clk)) {
 419                 ret1 = clk_set_parent(hw->clk, clk_pll2.hw.clk);
 420                 return ret1;
 421         }
 422
 423         if (rate == clk_get_rate(clk_pll3.hw.clk)) {
 424                 ret1 = clk_set_parent(hw->clk, clk_pll3.hw.clk);
 425                 return ret1;
 426         }
 427
 428         cur_parent = clk_get_parent(hw->clk);
 429
 430         /* switch to tmp pll before setting parent clock's rate */
 431         if (cur_parent ==  clk_pll1.hw.clk) {
 432                 ret1 = clk_set_parent(hw->clk, clk_pll2.hw.clk);
 433                 BUG_ON(ret1);
 434         }
 435
 436         ret2 = clk_set_rate(clk_pll1.hw.clk, rate);
 437
 438         ret1 = clk_set_parent(hw->clk, clk_pll1.hw.clk);
 439
 440         return ret2 ? ret2 : ret1;
 441 }
 442
 443 static const struct clk_ops msi_ops = {
 444         .set_rate = dmn_clk_set_rate,
 445         .round_rate = dmn_clk_round_rate,
 446         .recalc_rate = dmn_clk_recalc_rate,
 447         .set_parent = dmn_clk_set_parent,
 448         .get_parent = dmn_clk_get_parent,
 449 };
 450
 451 static const struct clk_init_data clk_mem_init = {
 452         .name = "mem",
 453         .ops = &msi_ops,
 454         .parent_names = dmn_clk_parents,
 455         .num_parents = ARRAY_SIZE(dmn_clk_parents),
 456 };
 457
 458 static struct clk_dmn clk_mem = {
 459         .regofs = SIRFSOC_CLKC_MEM_CFG,
 460         .hw = {
 461                 .init = &clk_mem_init,
 462         },
 463 };
 464
 465 static const struct clk_init_data clk_sys_init = {
 466         .name = "sys",
 467         .ops = &msi_ops,
 468         .parent_names = dmn_clk_parents,
 469         .num_parents = ARRAY_SIZE(dmn_clk_parents),
 470         .flags = CLK_SET_RATE_GATE,
 471 };
 472
 473 static struct clk_dmn clk_sys = {
 474         .regofs = SIRFSOC_CLKC_SYS_CFG,
 475         .hw = {
 476                 .init = &clk_sys_init,
 477         },
 478 };
 479
 480 static const struct clk_init_data clk_io_init = {
 481         .name = "io",
 482         .ops = &msi_ops,
 483         .parent_names = dmn_clk_parents,
 484         .num_parents = ARRAY_SIZE(dmn_clk_parents),
 485 };
 486
 487 static struct clk_dmn clk_io = {
 488         .regofs = SIRFSOC_CLKC_IO_CFG,
 489         .hw = {
 490                 .init = &clk_io_init,
 491         },
 492 };
 493
 494 static const struct clk_ops cpu_ops = {
 495         .set_parent = dmn_clk_set_parent,
 496         .get_parent = dmn_clk_get_parent,
 497         .set_rate = cpu_clk_set_rate,
 498         .round_rate = cpu_clk_round_rate,
 499         .recalc_rate = cpu_clk_recalc_rate,
 500 };
 501
 502 static const struct clk_init_data clk_cpu_init = {
 503         .name = "cpu",
 504         .ops = &cpu_ops,
 505         .parent_names = dmn_clk_parents,
 506         .num_parents = ARRAY_SIZE(dmn_clk_parents),
 507         .flags = CLK_SET_RATE_PARENT,
 508 };
 509
 510 static struct clk_dmn clk_cpu = {
 511         .regofs = SIRFSOC_CLKC_CPU_CFG,
 512         .hw = {
 513                 .init = &clk_cpu_init,
 514         },
 515 };
 516
 517 static const struct clk_ops dmn_ops = {
 518         .is_enabled = std_clk_is_enabled,
 519         .enable = std_clk_enable,
 520         .disable = std_clk_disable,
 521         .set_rate = dmn_clk_set_rate,
 522         .round_rate = dmn_clk_round_rate,
 523         .recalc_rate = dmn_clk_recalc_rate,
 524         .set_parent = dmn_clk_set_parent,
 525         .get_parent = dmn_clk_get_parent,
 526 };
 527
 528 /* dsp, gfx, mm, lcd and vpp domain */
 529
 530 static const struct clk_init_data clk_dsp_init = {
 531         .name = "dsp",
 532         .ops = &dmn_ops,
 533         .parent_names = dmn_clk_parents,
 534         .num_parents = ARRAY_SIZE(dmn_clk_parents),
 535 };
 536
 537 static struct clk_dmn clk_dsp = {
 538         .regofs = SIRFSOC_CLKC_DSP_CFG,
 539         .enable_bit = 0,
 540         .hw = {
 541                 .init = &clk_dsp_init,
 542         },
 543 };
 544
 545 static const struct clk_init_data clk_gfx_init = {
 546         .name = "gfx",
 547         .ops = &dmn_ops,
 548         .parent_names = dmn_clk_parents,
 549         .num_parents = ARRAY_SIZE(dmn_clk_parents),
 550 };
 551
 552 static struct clk_dmn clk_gfx = {
 553         .regofs = SIRFSOC_CLKC_GFX_CFG,
 554         .enable_bit = 8,
 555         .hw = {
 556                 .init = &clk_gfx_init,
 557         },
 558 };
 559
 560 static const struct clk_init_data clk_mm_init = {
 561         .name = "mm",
 562         .ops = &dmn_ops,
 563         .parent_names = dmn_clk_parents,
 564         .num_parents = ARRAY_SIZE(dmn_clk_parents),
 565 };
 566
 567 static struct clk_dmn clk_mm = {
 568         .regofs = SIRFSOC_CLKC_MM_CFG,
 569         .enable_bit = 9,
 570         .hw = {
 571                 .init = &clk_mm_init,
 572         },
 573 };
 574
 575 /*
 576  * for atlas6, gfx2d holds the bit of prima2's clk_mm
 577  */
 578 #define clk_gfx2d clk_mm
 579
 580 static const struct clk_init_data clk_lcd_init = {
 581         .name = "lcd",
 582         .ops = &dmn_ops,
 583         .parent_names = dmn_clk_parents,
 584         .num_parents = ARRAY_SIZE(dmn_clk_parents),
 585 };
 586
 587 static struct clk_dmn clk_lcd = {
 588         .regofs = SIRFSOC_CLKC_LCD_CFG,
 589         .enable_bit = 10,
 590         .hw = {
 591                 .init = &clk_lcd_init,
 592         },
 593 };
 594
 595 static const struct clk_init_data clk_vpp_init = {
 596         .name = "vpp",
 597         .ops = &dmn_ops,
 598         .parent_names = dmn_clk_parents,
 599         .num_parents = ARRAY_SIZE(dmn_clk_parents),
 600 };
 601
 602 static struct clk_dmn clk_vpp = {
 603         .regofs = SIRFSOC_CLKC_LCD_CFG,
 604         .enable_bit = 11,
 605         .hw = {
 606                 .init = &clk_vpp_init,
 607         },
 608 };
 609
 610 static const struct clk_init_data clk_mmc01_init = {
 611         .name = "mmc01",
 612         .ops = &dmn_ops,
 613         .parent_names = dmn_clk_parents,
 614         .num_parents = ARRAY_SIZE(dmn_clk_parents),
 615 };
 616
 617 static const struct clk_init_data clk_mmc23_init = {
 618         .name = "mmc23",
 619         .ops = &dmn_ops,
 620         .parent_names = dmn_clk_parents,
 621         .num_parents = ARRAY_SIZE(dmn_clk_parents),
 622 };
 623
 624 static const struct clk_init_data clk_mmc45_init = {
 625         .name = "mmc45",
 626         .ops = &dmn_ops,
 627         .parent_names = dmn_clk_parents,
 628         .num_parents = ARRAY_SIZE(dmn_clk_parents),
 629 };
 630
 631 /*
 632  * peripheral controllers in io domain
 633  */
 634
 635 static int std_clk_is_enabled(struct clk_hw *hw)
 636 {
 637         u32 reg;
 638         int bit;
 639         struct clk_std *clk = to_stdclk(hw);
 640
 641         bit = clk->enable_bit % 32;
 642         reg = clk->enable_bit / 32;
 643         reg = SIRFSOC_CLKC_CLK_EN0 + reg * sizeof(reg);
 644
 645         return !!(clkc_readl(reg) & BIT(bit));
 646 }
 647
 648 static int std_clk_enable(struct clk_hw *hw)
 649 {
 650         u32 val, reg;
 651         int bit;
 652         struct clk_std *clk = to_stdclk(hw);
 653
 654         BUG_ON(clk->enable_bit < 0 || clk->enable_bit > 63);
 655
 656         bit = clk->enable_bit % 32;
 657         reg = clk->enable_bit / 32;
 658         reg = SIRFSOC_CLKC_CLK_EN0 + reg * sizeof(reg);
 659
 660         val = clkc_readl(reg) | BIT(bit);
 661         clkc_writel(val, reg);
 662         return 0;
 663 }
 664
 665 static void std_clk_disable(struct clk_hw *hw)
 666 {
 667         u32 val, reg;
 668         int bit;
 669         struct clk_std *clk = to_stdclk(hw);
 670
 671         BUG_ON(clk->enable_bit < 0 || clk->enable_bit > 63);
 672
 673         bit = clk->enable_bit % 32;
 674         reg = clk->enable_bit / 32;
 675         reg = SIRFSOC_CLKC_CLK_EN0 + reg * sizeof(reg);
 676
 677         val = clkc_readl(reg) & ~BIT(bit);
 678         clkc_writel(val, reg);
 679 }
 680
 681 static const char * const std_clk_io_parents[] = {
 682         "io",
 683 };
 684
 685 static const struct clk_ops ios_ops = {
 686         .is_enabled = std_clk_is_enabled,
 687         .enable = std_clk_enable,
 688         .disable = std_clk_disable,
 689 };
 690
 691 static const struct clk_init_data clk_cphif_init = {
 692         .name = "cphif",
 693         .ops = &ios_ops,
 694         .parent_names = std_clk_io_parents,
 695         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 696 };
 697
 698 static struct clk_std clk_cphif = {
 699         .enable_bit = 20,
 700         .hw = {
 701                 .init = &clk_cphif_init,
 702         },
 703 };
 704
 705 static const struct clk_init_data clk_dmac0_init = {
 706         .name = "dmac0",
 707         .ops = &ios_ops,
 708         .parent_names = std_clk_io_parents,
 709         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 710 };
 711
 712 static struct clk_std clk_dmac0 = {
 713         .enable_bit = 32,
 714         .hw = {
 715                 .init = &clk_dmac0_init,
 716         },
 717 };
 718
 719 static const struct clk_init_data clk_dmac1_init = {
 720         .name = "dmac1",
 721         .ops = &ios_ops,
 722         .parent_names = std_clk_io_parents,
 723         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 724 };
 725
 726 static struct clk_std clk_dmac1 = {
 727         .enable_bit = 33,
 728         .hw = {
 729                 .init = &clk_dmac1_init,
 730         },
 731 };
 732
 733 static const struct clk_init_data clk_audio_init = {
 734         .name = "audio",
 735         .ops = &ios_ops,
 736         .parent_names = std_clk_io_parents,
 737         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 738 };
 739
 740 static struct clk_std clk_audio = {
 741         .enable_bit = 35,
 742         .hw = {
 743                 .init = &clk_audio_init,
 744         },
 745 };
 746
 747 static const struct clk_init_data clk_uart0_init = {
 748         .name = "uart0",
 749         .ops = &ios_ops,
 750         .parent_names = std_clk_io_parents,
 751         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 752 };
 753
 754 static struct clk_std clk_uart0 = {
 755         .enable_bit = 36,
 756         .hw = {
 757                 .init = &clk_uart0_init,
 758         },
 759 };
 760
 761 static const struct clk_init_data clk_uart1_init = {
 762         .name = "uart1",
 763         .ops = &ios_ops,
 764         .parent_names = std_clk_io_parents,
 765         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 766 };
 767
 768 static struct clk_std clk_uart1 = {
 769         .enable_bit = 37,
 770         .hw = {
 771                 .init = &clk_uart1_init,
 772         },
 773 };
 774
 775 static const struct clk_init_data clk_uart2_init = {
 776         .name = "uart2",
 777         .ops = &ios_ops,
 778         .parent_names = std_clk_io_parents,
 779         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 780 };
 781
 782 static struct clk_std clk_uart2 = {
 783         .enable_bit = 38,
 784         .hw = {
 785                 .init = &clk_uart2_init,
 786         },
 787 };
 788
 789 static const struct clk_init_data clk_usp0_init = {
 790         .name = "usp0",
 791         .ops = &ios_ops,
 792         .parent_names = std_clk_io_parents,
 793         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 794 };
 795
 796 static struct clk_std clk_usp0 = {
 797         .enable_bit = 39,
 798         .hw = {
 799                 .init = &clk_usp0_init,
 800         },
 801 };
 802
 803 static const struct clk_init_data clk_usp1_init = {
 804         .name = "usp1",
 805         .ops = &ios_ops,
 806         .parent_names = std_clk_io_parents,
 807         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 808 };
 809
 810 static struct clk_std clk_usp1 = {
 811         .enable_bit = 40,
 812         .hw = {
 813                 .init = &clk_usp1_init,
 814         },
 815 };
 816
 817 static const struct clk_init_data clk_usp2_init = {
 818         .name = "usp2",
 819         .ops = &ios_ops,
 820         .parent_names = std_clk_io_parents,
 821         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 822 };
 823
 824 static struct clk_std clk_usp2 = {
 825         .enable_bit = 41,
 826         .hw = {
 827                 .init = &clk_usp2_init,
 828         },
 829 };
 830
 831 static const struct clk_init_data clk_vip_init = {
 832         .name = "vip",
 833         .ops = &ios_ops,
 834         .parent_names = std_clk_io_parents,
 835         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 836 };
 837
 838 static struct clk_std clk_vip = {
 839         .enable_bit = 42,
 840         .hw = {
 841                 .init = &clk_vip_init,
 842         },
 843 };
 844
 845 static const struct clk_init_data clk_spi0_init = {
 846         .name = "spi0",
 847         .ops = &ios_ops,
 848         .parent_names = std_clk_io_parents,
 849         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 850 };
 851
 852 static struct clk_std clk_spi0 = {
 853         .enable_bit = 43,
 854         .hw = {
 855                 .init = &clk_spi0_init,
 856         },
 857 };
 858
 859 static const struct clk_init_data clk_spi1_init = {
 860         .name = "spi1",
 861         .ops = &ios_ops,
 862         .parent_names = std_clk_io_parents,
 863         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 864 };
 865
 866 static struct clk_std clk_spi1 = {
 867         .enable_bit = 44,
 868         .hw = {
 869                 .init = &clk_spi1_init,
 870         },
 871 };
 872
 873 static const struct clk_init_data clk_tsc_init = {
 874         .name = "tsc",
 875         .ops = &ios_ops,
 876         .parent_names = std_clk_io_parents,
 877         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 878 };
 879
 880 static struct clk_std clk_tsc = {
 881         .enable_bit = 45,
 882         .hw = {
 883                 .init = &clk_tsc_init,
 884         },
 885 };
 886
 887 static const struct clk_init_data clk_i2c0_init = {
 888         .name = "i2c0",
 889         .ops = &ios_ops,
 890         .parent_names = std_clk_io_parents,
 891         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 892 };
 893
 894 static struct clk_std clk_i2c0 = {
 895         .enable_bit = 46,
 896         .hw = {
 897                 .init = &clk_i2c0_init,
 898         },
 899 };
 900
 901 static const struct clk_init_data clk_i2c1_init = {
 902         .name = "i2c1",
 903         .ops = &ios_ops,
 904         .parent_names = std_clk_io_parents,
 905         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 906 };
 907
 908 static struct clk_std clk_i2c1 = {
 909         .enable_bit = 47,
 910         .hw = {
 911                 .init = &clk_i2c1_init,
 912         },
 913 };
 914
 915 static const struct clk_init_data clk_pwmc_init = {
 916         .name = "pwmc",
 917         .ops = &ios_ops,
 918         .parent_names = std_clk_io_parents,
 919         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 920 };
 921
 922 static struct clk_std clk_pwmc = {
 923         .enable_bit = 48,
 924         .hw = {
 925                 .init = &clk_pwmc_init,
 926         },
 927 };
 928
 929 static const struct clk_init_data clk_efuse_init = {
 930         .name = "efuse",
 931         .ops = &ios_ops,
 932         .parent_names = std_clk_io_parents,
 933         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 934 };
 935
 936 static struct clk_std clk_efuse = {
 937         .enable_bit = 49,
 938         .hw = {
 939                 .init = &clk_efuse_init,
 940         },
 941 };
 942
 943 static const struct clk_init_data clk_pulse_init = {
 944         .name = "pulse",
 945         .ops = &ios_ops,
 946         .parent_names = std_clk_io_parents,
 947         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 948 };
 949
 950 static struct clk_std clk_pulse = {
 951         .enable_bit = 50,
 952         .hw = {
 953                 .init = &clk_pulse_init,
 954         },
 955 };
 956
 957 static const char * const std_clk_dsp_parents[] = {
 958         "dsp",
 959 };
 960
 961 static const struct clk_init_data clk_gps_init = {
 962         .name = "gps",
 963         .ops = &ios_ops,
 964         .parent_names = std_clk_dsp_parents,
 965         .num_parents = ARRAY_SIZE(std_clk_dsp_parents),
 966 };
 967
 968 static struct clk_std clk_gps = {
 969         .enable_bit = 1,
 970         .hw = {
 971                 .init = &clk_gps_init,
 972         },
 973 };
 974
 975 static const struct clk_init_data clk_mf_init = {
 976         .name = "mf",
 977         .ops = &ios_ops,
 978         .parent_names = std_clk_io_parents,
 979         .num_parents = ARRAY_SIZE(std_clk_io_parents),
 980 };
 981
 982 static struct clk_std clk_mf = {
 983         .enable_bit = 2,
 984         .hw = {
 985                 .init = &clk_mf_init,
 986         },
 987 };
 988
 989 static const char * const std_clk_sys_parents[] = {
 990         "sys",
 991 };
 992
 993 static const struct clk_init_data clk_security_init = {
 994         .name = "security",
 995         .ops = &ios_ops,
 996         .parent_names = std_clk_sys_parents,
 997         .num_parents = ARRAY_SIZE(std_clk_sys_parents),
 998 };
 999
1000 static struct clk_std clk_security = {
1001         .enable_bit = 19,
1002         .hw = {
1003                 .init = &clk_security_init,
1004         },
1005 };
1006
1007 static const char * const std_clk_usb_parents[] = {
1008         "usb_pll",
1009 };
1010
1011 static const struct clk_init_data clk_usb0_init = {
1012         .name = "usb0",
1013         .ops = &ios_ops,
1014         .parent_names = std_clk_usb_parents,
1015         .num_parents = ARRAY_SIZE(std_clk_usb_parents),
1016 };
1017
1018 static struct clk_std clk_usb0 = {
1019         .enable_bit = 16,
1020         .hw = {
1021                 .init = &clk_usb0_init,
1022         },
1023 };
1024
1025 static const struct clk_init_data clk_usb1_init = {
1026         .name = "usb1",
1027         .ops = &ios_ops,
1028         .parent_names = std_clk_usb_parents,
1029         .num_parents = ARRAY_SIZE(std_clk_usb_parents),
1030 };
1031
1032 static struct clk_std clk_usb1 = {
1033         .enable_bit = 17,
1034         .hw = {
1035                 .init = &clk_usb1_init,
1036         },
1037 };