| b.liu | e958203 | 2025-04-17 19:18:16 +0800 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0 |
| 2 | /* |
| 3 | * arch/sh/kernel/cpu/sh2a/clock-sh7264.c |
| 4 | * |
| 5 | * SH7264 clock framework support |
| 6 | * |
| 7 | * Copyright (C) 2012 Phil Edworthy |
| 8 | */ |
| 9 | #include <linux/init.h> |
| 10 | #include <linux/kernel.h> |
| 11 | #include <linux/io.h> |
| 12 | #include <linux/clkdev.h> |
| 13 | #include <asm/clock.h> |
| 14 | |
| 15 | /* SH7264 registers */ |
| 16 | #define FRQCR 0xfffe0010 |
| 17 | #define STBCR3 0xfffe0408 |
| 18 | #define STBCR4 0xfffe040c |
| 19 | #define STBCR5 0xfffe0410 |
| 20 | #define STBCR6 0xfffe0414 |
| 21 | #define STBCR7 0xfffe0418 |
| 22 | #define STBCR8 0xfffe041c |
| 23 | |
| 24 | static const unsigned int pll1rate[] = {8, 12}; |
| 25 | |
| 26 | static unsigned int pll1_div; |
| 27 | |
| 28 | /* Fixed 32 KHz root clock for RTC */ |
| 29 | static struct clk r_clk = { |
| 30 | .rate = 32768, |
| 31 | }; |
| 32 | |
| 33 | /* |
| 34 | * Default rate for the root input clock, reset this with clk_set_rate() |
| 35 | * from the platform code. |
| 36 | */ |
| 37 | static struct clk extal_clk = { |
| 38 | .rate = 18000000, |
| 39 | }; |
| 40 | |
| 41 | static unsigned long pll_recalc(struct clk *clk) |
| 42 | { |
| 43 | unsigned long rate = clk->parent->rate / pll1_div; |
| 44 | return rate * pll1rate[(__raw_readw(FRQCR) >> 8) & 1]; |
| 45 | } |
| 46 | |
| 47 | static struct sh_clk_ops pll_clk_ops = { |
| 48 | .recalc = pll_recalc, |
| 49 | }; |
| 50 | |
| 51 | static struct clk pll_clk = { |
| 52 | .ops = &pll_clk_ops, |
| 53 | .parent = &extal_clk, |
| 54 | .flags = CLK_ENABLE_ON_INIT, |
| 55 | }; |
| 56 | |
| 57 | struct clk *main_clks[] = { |
| 58 | &r_clk, |
| 59 | &extal_clk, |
| 60 | &pll_clk, |
| 61 | }; |
| 62 | |
| 63 | static int div2[] = { 1, 2, 3, 4, 6, 8, 12 }; |
| 64 | |
| 65 | static struct clk_div_mult_table div4_div_mult_table = { |
| 66 | .divisors = div2, |
| 67 | .nr_divisors = ARRAY_SIZE(div2), |
| 68 | }; |
| 69 | |
| 70 | static struct clk_div4_table div4_table = { |
| 71 | .div_mult_table = &div4_div_mult_table, |
| 72 | }; |
| 73 | |
| 74 | enum { DIV4_I, DIV4_P, |
| 75 | DIV4_NR }; |
| 76 | |
| 77 | #define DIV4(_reg, _bit, _mask, _flags) \ |
| 78 | SH_CLK_DIV4(&pll_clk, _reg, _bit, _mask, _flags) |
| 79 | |
| 80 | /* The mask field specifies the div2 entries that are valid */ |
| 81 | struct clk div4_clks[DIV4_NR] = { |
| 82 | [DIV4_I] = DIV4(FRQCR, 4, 0x7, CLK_ENABLE_REG_16BIT |
| 83 | | CLK_ENABLE_ON_INIT), |
| 84 | [DIV4_P] = DIV4(FRQCR, 0, 0x78, CLK_ENABLE_REG_16BIT), |
| 85 | }; |
| 86 | |
| 87 | enum { MSTP77, MSTP74, MSTP72, |
| 88 | MSTP60, |
| 89 | MSTP35, MSTP34, MSTP33, MSTP32, MSTP30, |
| 90 | MSTP_NR }; |
| 91 | |
| 92 | static struct clk mstp_clks[MSTP_NR] = { |
| 93 | [MSTP77] = SH_CLK_MSTP8(&div4_clks[DIV4_P], STBCR7, 7, 0), /* SCIF */ |
| 94 | [MSTP74] = SH_CLK_MSTP8(&div4_clks[DIV4_P], STBCR7, 4, 0), /* VDC */ |
| 95 | [MSTP72] = SH_CLK_MSTP8(&div4_clks[DIV4_P], STBCR7, 2, 0), /* CMT */ |
| 96 | [MSTP60] = SH_CLK_MSTP8(&div4_clks[DIV4_P], STBCR6, 0, 0), /* USB */ |
| 97 | [MSTP35] = SH_CLK_MSTP8(&div4_clks[DIV4_P], STBCR3, 6, 0), /* MTU2 */ |
| 98 | [MSTP34] = SH_CLK_MSTP8(&div4_clks[DIV4_P], STBCR3, 4, 0), /* SDHI0 */ |
| 99 | [MSTP33] = SH_CLK_MSTP8(&div4_clks[DIV4_P], STBCR3, 3, 0), /* SDHI1 */ |
| 100 | [MSTP32] = SH_CLK_MSTP8(&div4_clks[DIV4_P], STBCR3, 2, 0), /* ADC */ |
| 101 | [MSTP30] = SH_CLK_MSTP8(&r_clk, STBCR3, 0, 0), /* RTC */ |
| 102 | }; |
| 103 | |
| 104 | static struct clk_lookup lookups[] = { |
| 105 | /* main clocks */ |
| 106 | CLKDEV_CON_ID("rclk", &r_clk), |
| 107 | CLKDEV_CON_ID("extal", &extal_clk), |
| 108 | CLKDEV_CON_ID("pll_clk", &pll_clk), |
| 109 | |
| 110 | /* DIV4 clocks */ |
| 111 | CLKDEV_CON_ID("cpu_clk", &div4_clks[DIV4_I]), |
| 112 | CLKDEV_CON_ID("peripheral_clk", &div4_clks[DIV4_P]), |
| 113 | |
| 114 | /* MSTP clocks */ |
| 115 | CLKDEV_ICK_ID("fck", "sh-sci.0", &mstp_clks[MSTP77]), |
| 116 | CLKDEV_ICK_ID("fck", "sh-sci.1", &mstp_clks[MSTP77]), |
| 117 | CLKDEV_ICK_ID("fck", "sh-sci.2", &mstp_clks[MSTP77]), |
| 118 | CLKDEV_ICK_ID("fck", "sh-sci.3", &mstp_clks[MSTP77]), |
| 119 | CLKDEV_ICK_ID("fck", "sh-sci.4", &mstp_clks[MSTP77]), |
| 120 | CLKDEV_ICK_ID("fck", "sh-sci.5", &mstp_clks[MSTP77]), |
| 121 | CLKDEV_ICK_ID("fck", "sh-sci.6", &mstp_clks[MSTP77]), |
| 122 | CLKDEV_ICK_ID("fck", "sh-sci.7", &mstp_clks[MSTP77]), |
| 123 | CLKDEV_CON_ID("vdc3", &mstp_clks[MSTP74]), |
| 124 | CLKDEV_ICK_ID("fck", "sh-cmt-16.0", &mstp_clks[MSTP72]), |
| 125 | CLKDEV_CON_ID("usb0", &mstp_clks[MSTP60]), |
| 126 | CLKDEV_ICK_ID("fck", "sh-mtu2", &mstp_clks[MSTP35]), |
| 127 | CLKDEV_CON_ID("sdhi0", &mstp_clks[MSTP34]), |
| 128 | CLKDEV_CON_ID("sdhi1", &mstp_clks[MSTP33]), |
| 129 | CLKDEV_CON_ID("adc0", &mstp_clks[MSTP32]), |
| 130 | CLKDEV_CON_ID("rtc0", &mstp_clks[MSTP30]), |
| 131 | }; |
| 132 | |
| 133 | int __init arch_clk_init(void) |
| 134 | { |
| 135 | int k, ret = 0; |
| 136 | |
| 137 | if (test_mode_pin(MODE_PIN0)) { |
| 138 | if (test_mode_pin(MODE_PIN1)) |
| 139 | pll1_div = 3; |
| 140 | else |
| 141 | pll1_div = 4; |
| 142 | } else |
| 143 | pll1_div = 1; |
| 144 | |
| 145 | for (k = 0; !ret && (k < ARRAY_SIZE(main_clks)); k++) |
| 146 | ret = clk_register(main_clks[k]); |
| 147 | |
| 148 | clkdev_add_table(lookups, ARRAY_SIZE(lookups)); |
| 149 | |
| 150 | if (!ret) |
| 151 | ret = sh_clk_div4_register(div4_clks, DIV4_NR, &div4_table); |
| 152 | |
| 153 | if (!ret) |
| 154 | ret = sh_clk_mstp_register(mstp_clks, MSTP_NR); |
| 155 | |
| 156 | return ret; |
| 157 | } |