diff options
Diffstat (limited to 'arch/arm/mach-imx')
29 files changed, 3542 insertions, 8008 deletions
diff --git a/arch/arm/mach-imx/Kconfig b/arch/arm/mach-imx/Kconfig index cca8c0c74794..0021f726b153 100644 --- a/arch/arm/mach-imx/Kconfig +++ b/arch/arm/mach-imx/Kconfig | |||
@@ -34,6 +34,7 @@ config ARCH_MX53 | |||
34 | config SOC_IMX1 | 34 | config SOC_IMX1 |
35 | bool | 35 | bool |
36 | select ARCH_MX1 | 36 | select ARCH_MX1 |
37 | select COMMON_CLK | ||
37 | select CPU_ARM920T | 38 | select CPU_ARM920T |
38 | select IMX_HAVE_IOMUX_V1 | 39 | select IMX_HAVE_IOMUX_V1 |
39 | select MXC_AVIC | 40 | select MXC_AVIC |
@@ -42,12 +43,14 @@ config SOC_IMX21 | |||
42 | bool | 43 | bool |
43 | select MACH_MX21 | 44 | select MACH_MX21 |
44 | select CPU_ARM926T | 45 | select CPU_ARM926T |
46 | select COMMON_CLK | ||
45 | select IMX_HAVE_IOMUX_V1 | 47 | select IMX_HAVE_IOMUX_V1 |
46 | select MXC_AVIC | 48 | select MXC_AVIC |
47 | 49 | ||
48 | config SOC_IMX25 | 50 | config SOC_IMX25 |
49 | bool | 51 | bool |
50 | select ARCH_MX25 | 52 | select ARCH_MX25 |
53 | select COMMON_CLK | ||
51 | select CPU_ARM926T | 54 | select CPU_ARM926T |
52 | select ARCH_MXC_IOMUX_V3 | 55 | select ARCH_MXC_IOMUX_V3 |
53 | select MXC_AVIC | 56 | select MXC_AVIC |
@@ -56,6 +59,7 @@ config SOC_IMX27 | |||
56 | bool | 59 | bool |
57 | select MACH_MX27 | 60 | select MACH_MX27 |
58 | select CPU_ARM926T | 61 | select CPU_ARM926T |
62 | select COMMON_CLK | ||
59 | select IMX_HAVE_IOMUX_V1 | 63 | select IMX_HAVE_IOMUX_V1 |
60 | select MXC_AVIC | 64 | select MXC_AVIC |
61 | 65 | ||
@@ -64,12 +68,14 @@ config SOC_IMX31 | |||
64 | select CPU_V6 | 68 | select CPU_V6 |
65 | select IMX_HAVE_PLATFORM_MXC_RNGA | 69 | select IMX_HAVE_PLATFORM_MXC_RNGA |
66 | select MXC_AVIC | 70 | select MXC_AVIC |
71 | select COMMON_CLK | ||
67 | select SMP_ON_UP if SMP | 72 | select SMP_ON_UP if SMP |
68 | 73 | ||
69 | config SOC_IMX35 | 74 | config SOC_IMX35 |
70 | bool | 75 | bool |
71 | select CPU_V6 | 76 | select CPU_V6 |
72 | select ARCH_MXC_IOMUX_V3 | 77 | select ARCH_MXC_IOMUX_V3 |
78 | select COMMON_CLK | ||
73 | select HAVE_EPIT | 79 | select HAVE_EPIT |
74 | select MXC_AVIC | 80 | select MXC_AVIC |
75 | select SMP_ON_UP if SMP | 81 | select SMP_ON_UP if SMP |
@@ -77,6 +83,7 @@ config SOC_IMX35 | |||
77 | config SOC_IMX5 | 83 | config SOC_IMX5 |
78 | select CPU_V7 | 84 | select CPU_V7 |
79 | select MXC_TZIC | 85 | select MXC_TZIC |
86 | select COMMON_CLK | ||
80 | select ARCH_MXC_IOMUX_V3 | 87 | select ARCH_MXC_IOMUX_V3 |
81 | select ARCH_HAS_CPUFREQ | 88 | select ARCH_HAS_CPUFREQ |
82 | select ARCH_MX5 | 89 | select ARCH_MX5 |
@@ -815,6 +822,7 @@ config SOC_IMX6Q | |||
815 | bool "i.MX6 Quad support" | 822 | bool "i.MX6 Quad support" |
816 | select ARM_CPU_SUSPEND if PM | 823 | select ARM_CPU_SUSPEND if PM |
817 | select ARM_GIC | 824 | select ARM_GIC |
825 | select COMMON_CLK | ||
818 | select CPU_V7 | 826 | select CPU_V7 |
819 | select HAVE_ARM_SCU | 827 | select HAVE_ARM_SCU |
820 | select HAVE_IMX_GPC | 828 | select HAVE_IMX_GPC |
diff --git a/arch/arm/mach-imx/Makefile b/arch/arm/mach-imx/Makefile index 4937c070a57e..ff29421414f2 100644 --- a/arch/arm/mach-imx/Makefile +++ b/arch/arm/mach-imx/Makefile | |||
@@ -1,15 +1,18 @@ | |||
1 | obj-$(CONFIG_SOC_IMX1) += clock-imx1.o mm-imx1.o | 1 | obj-$(CONFIG_SOC_IMX1) += clk-imx1.o mm-imx1.o |
2 | obj-$(CONFIG_SOC_IMX21) += clock-imx21.o mm-imx21.o | 2 | obj-$(CONFIG_SOC_IMX21) += clk-imx21.o mm-imx21.o |
3 | 3 | ||
4 | obj-$(CONFIG_SOC_IMX25) += clock-imx25.o mm-imx25.o ehci-imx25.o cpu-imx25.o | 4 | obj-$(CONFIG_SOC_IMX25) += clk-imx25.o mm-imx25.o ehci-imx25.o cpu-imx25.o |
5 | 5 | ||
6 | obj-$(CONFIG_SOC_IMX27) += cpu-imx27.o pm-imx27.o | 6 | obj-$(CONFIG_SOC_IMX27) += cpu-imx27.o pm-imx27.o |
7 | obj-$(CONFIG_SOC_IMX27) += clock-imx27.o mm-imx27.o ehci-imx27.o | 7 | obj-$(CONFIG_SOC_IMX27) += clk-imx27.o mm-imx27.o ehci-imx27.o |
8 | 8 | ||
9 | obj-$(CONFIG_SOC_IMX31) += mm-imx3.o cpu-imx31.o clock-imx31.o iomux-imx31.o ehci-imx31.o pm-imx3.o | 9 | obj-$(CONFIG_SOC_IMX31) += mm-imx3.o cpu-imx31.o clk-imx31.o iomux-imx31.o ehci-imx31.o pm-imx3.o |
10 | obj-$(CONFIG_SOC_IMX35) += mm-imx3.o cpu-imx35.o clock-imx35.o ehci-imx35.o pm-imx3.o | 10 | obj-$(CONFIG_SOC_IMX35) += mm-imx3.o cpu-imx35.o clk-imx35.o ehci-imx35.o pm-imx3.o |
11 | 11 | ||
12 | obj-$(CONFIG_SOC_IMX5) += cpu-imx5.o mm-imx5.o clock-mx51-mx53.o ehci-imx5.o pm-imx5.o cpu_op-mx51.o | 12 | obj-$(CONFIG_SOC_IMX5) += cpu-imx5.o mm-imx5.o clk-imx51-imx53.o ehci-imx5.o pm-imx5.o cpu_op-mx51.o |
13 | |||
14 | obj-$(CONFIG_COMMON_CLK) += clk-pllv1.o clk-pllv2.o clk-pllv3.o clk-gate2.o \ | ||
15 | clk-pfd.o clk-busy.o | ||
13 | 16 | ||
14 | # Support for CMOS sensor interface | 17 | # Support for CMOS sensor interface |
15 | obj-$(CONFIG_MX1_VIDEO) += mx1-camera-fiq.o mx1-camera-fiq-ksym.o | 18 | obj-$(CONFIG_MX1_VIDEO) += mx1-camera-fiq.o mx1-camera-fiq-ksym.o |
@@ -70,7 +73,7 @@ obj-$(CONFIG_CPU_V7) += head-v7.o | |||
70 | AFLAGS_head-v7.o :=-Wa,-march=armv7-a | 73 | AFLAGS_head-v7.o :=-Wa,-march=armv7-a |
71 | obj-$(CONFIG_SMP) += platsmp.o | 74 | obj-$(CONFIG_SMP) += platsmp.o |
72 | obj-$(CONFIG_HOTPLUG_CPU) += hotplug.o | 75 | obj-$(CONFIG_HOTPLUG_CPU) += hotplug.o |
73 | obj-$(CONFIG_SOC_IMX6Q) += clock-imx6q.o mach-imx6q.o | 76 | obj-$(CONFIG_SOC_IMX6Q) += clk-imx6q.o mach-imx6q.o |
74 | 77 | ||
75 | ifeq ($(CONFIG_PM),y) | 78 | ifeq ($(CONFIG_PM),y) |
76 | obj-$(CONFIG_SOC_IMX6Q) += pm-imx6q.o | 79 | obj-$(CONFIG_SOC_IMX6Q) += pm-imx6q.o |
diff --git a/arch/arm/mach-imx/clk-busy.c b/arch/arm/mach-imx/clk-busy.c new file mode 100644 index 000000000000..1a7a8dd045a1 --- /dev/null +++ b/arch/arm/mach-imx/clk-busy.c | |||
@@ -0,0 +1,189 @@ | |||
1 | /* | ||
2 | * Copyright 2012 Freescale Semiconductor, Inc. | ||
3 | * Copyright 2012 Linaro Ltd. | ||
4 | * | ||
5 | * The code contained herein is licensed under the GNU General Public | ||
6 | * License. You may obtain a copy of the GNU General Public License | ||
7 | * Version 2 or later at the following locations: | ||
8 | * | ||
9 | * http://www.opensource.org/licenses/gpl-license.html | ||
10 | * http://www.gnu.org/copyleft/gpl.html | ||
11 | */ | ||
12 | |||
13 | #include <linux/clk.h> | ||
14 | #include <linux/clk-provider.h> | ||
15 | #include <linux/io.h> | ||
16 | #include <linux/slab.h> | ||
17 | #include <linux/jiffies.h> | ||
18 | #include <linux/err.h> | ||
19 | #include "clk.h" | ||
20 | |||
21 | static int clk_busy_wait(void __iomem *reg, u8 shift) | ||
22 | { | ||
23 | unsigned long timeout = jiffies + msecs_to_jiffies(10); | ||
24 | |||
25 | while (readl_relaxed(reg) & (1 << shift)) | ||
26 | if (time_after(jiffies, timeout)) | ||
27 | return -ETIMEDOUT; | ||
28 | |||
29 | return 0; | ||
30 | } | ||
31 | |||
32 | struct clk_busy_divider { | ||
33 | struct clk_divider div; | ||
34 | const struct clk_ops *div_ops; | ||
35 | void __iomem *reg; | ||
36 | u8 shift; | ||
37 | }; | ||
38 | |||
39 | static inline struct clk_busy_divider *to_clk_busy_divider(struct clk_hw *hw) | ||
40 | { | ||
41 | struct clk_divider *div = container_of(hw, struct clk_divider, hw); | ||
42 | |||
43 | return container_of(div, struct clk_busy_divider, div); | ||
44 | } | ||
45 | |||
46 | static unsigned long clk_busy_divider_recalc_rate(struct clk_hw *hw, | ||
47 | unsigned long parent_rate) | ||
48 | { | ||
49 | struct clk_busy_divider *busy = to_clk_busy_divider(hw); | ||
50 | |||
51 | return busy->div_ops->recalc_rate(&busy->div.hw, parent_rate); | ||
52 | } | ||
53 | |||
54 | static long clk_busy_divider_round_rate(struct clk_hw *hw, unsigned long rate, | ||
55 | unsigned long *prate) | ||
56 | { | ||
57 | struct clk_busy_divider *busy = to_clk_busy_divider(hw); | ||
58 | |||
59 | return busy->div_ops->round_rate(&busy->div.hw, rate, prate); | ||
60 | } | ||
61 | |||
62 | static int clk_busy_divider_set_rate(struct clk_hw *hw, unsigned long rate, | ||
63 | unsigned long parent_rate) | ||
64 | { | ||
65 | struct clk_busy_divider *busy = to_clk_busy_divider(hw); | ||
66 | int ret; | ||
67 | |||
68 | ret = busy->div_ops->set_rate(&busy->div.hw, rate, parent_rate); | ||
69 | if (!ret) | ||
70 | ret = clk_busy_wait(busy->reg, busy->shift); | ||
71 | |||
72 | return ret; | ||
73 | } | ||
74 | |||
75 | static struct clk_ops clk_busy_divider_ops = { | ||
76 | .recalc_rate = clk_busy_divider_recalc_rate, | ||
77 | .round_rate = clk_busy_divider_round_rate, | ||
78 | .set_rate = clk_busy_divider_set_rate, | ||
79 | }; | ||
80 | |||
81 | struct clk *imx_clk_busy_divider(const char *name, const char *parent_name, | ||
82 | void __iomem *reg, u8 shift, u8 width, | ||
83 | void __iomem *busy_reg, u8 busy_shift) | ||
84 | { | ||
85 | struct clk_busy_divider *busy; | ||
86 | struct clk *clk; | ||
87 | struct clk_init_data init; | ||
88 | |||
89 | busy = kzalloc(sizeof(*busy), GFP_KERNEL); | ||
90 | if (!busy) | ||
91 | return ERR_PTR(-ENOMEM); | ||
92 | |||
93 | busy->reg = busy_reg; | ||
94 | busy->shift = busy_shift; | ||
95 | |||
96 | busy->div.reg = reg; | ||
97 | busy->div.shift = shift; | ||
98 | busy->div.width = width; | ||
99 | busy->div.lock = &imx_ccm_lock; | ||
100 | busy->div_ops = &clk_divider_ops; | ||
101 | |||
102 | init.name = name; | ||
103 | init.ops = &clk_busy_divider_ops; | ||
104 | init.flags = CLK_SET_RATE_PARENT; | ||
105 | init.parent_names = &parent_name; | ||
106 | init.num_parents = 1; | ||
107 | |||
108 | busy->div.hw.init = &init; | ||
109 | |||
110 | clk = clk_register(NULL, &busy->div.hw); | ||
111 | if (!clk) | ||
112 | kfree(busy); | ||
113 | |||
114 | return clk; | ||
115 | } | ||
116 | |||
117 | struct clk_busy_mux { | ||
118 | struct clk_mux mux; | ||
119 | const struct clk_ops *mux_ops; | ||
120 | void __iomem *reg; | ||
121 | u8 shift; | ||
122 | }; | ||
123 | |||
124 | static inline struct clk_busy_mux *to_clk_busy_mux(struct clk_hw *hw) | ||
125 | { | ||
126 | struct clk_mux *mux = container_of(hw, struct clk_mux, hw); | ||
127 | |||
128 | return container_of(mux, struct clk_busy_mux, mux); | ||
129 | } | ||
130 | |||
131 | static u8 clk_busy_mux_get_parent(struct clk_hw *hw) | ||
132 | { | ||
133 | struct clk_busy_mux *busy = to_clk_busy_mux(hw); | ||
134 | |||
135 | return busy->mux_ops->get_parent(&busy->mux.hw); | ||
136 | } | ||
137 | |||
138 | static int clk_busy_mux_set_parent(struct clk_hw *hw, u8 index) | ||
139 | { | ||
140 | struct clk_busy_mux *busy = to_clk_busy_mux(hw); | ||
141 | int ret; | ||
142 | |||
143 | ret = busy->mux_ops->set_parent(&busy->mux.hw, index); | ||
144 | if (!ret) | ||
145 | ret = clk_busy_wait(busy->reg, busy->shift); | ||
146 | |||
147 | return ret; | ||
148 | } | ||
149 | |||
150 | struct clk_ops clk_busy_mux_ops = { | ||
151 | .get_parent = clk_busy_mux_get_parent, | ||
152 | .set_parent = clk_busy_mux_set_parent, | ||
153 | }; | ||
154 | |||
155 | struct clk *imx_clk_busy_mux(const char *name, void __iomem *reg, u8 shift, | ||
156 | u8 width, void __iomem *busy_reg, u8 busy_shift, | ||
157 | const char **parent_names, int num_parents) | ||
158 | { | ||
159 | struct clk_busy_mux *busy; | ||
160 | struct clk *clk; | ||
161 | struct clk_init_data init; | ||
162 | |||
163 | busy = kzalloc(sizeof(*busy), GFP_KERNEL); | ||
164 | if (!busy) | ||
165 | return ERR_PTR(-ENOMEM); | ||
166 | |||
167 | busy->reg = busy_reg; | ||
168 | busy->shift = busy_shift; | ||
169 | |||
170 | busy->mux.reg = reg; | ||
171 | busy->mux.shift = shift; | ||
172 | busy->mux.width = width; | ||
173 | busy->mux.lock = &imx_ccm_lock; | ||
174 | busy->mux_ops = &clk_mux_ops; | ||
175 | |||
176 | init.name = name; | ||
177 | init.ops = &clk_busy_mux_ops; | ||
178 | init.flags = 0; | ||
179 | init.parent_names = parent_names; | ||
180 | init.num_parents = num_parents; | ||
181 | |||
182 | busy->mux.hw.init = &init; | ||
183 | |||
184 | clk = clk_register(NULL, &busy->mux.hw); | ||
185 | if (IS_ERR(clk)) | ||
186 | kfree(busy); | ||
187 | |||
188 | return clk; | ||
189 | } | ||
diff --git a/arch/arm/mach-imx/clk-gate2.c b/arch/arm/mach-imx/clk-gate2.c new file mode 100644 index 000000000000..3c1b8ff9a0a6 --- /dev/null +++ b/arch/arm/mach-imx/clk-gate2.c | |||
@@ -0,0 +1,118 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2010-2011 Canonical Ltd <jeremy.kerr@canonical.com> | ||
3 | * Copyright (C) 2011-2012 Mike Turquette, Linaro Ltd <mturquette@linaro.org> | ||
4 | * | ||
5 | * This program is free software; you can redistribute it and/or modify | ||
6 | * it under the terms of the GNU General Public License version 2 as | ||
7 | * published by the Free Software Foundation. | ||
8 | * | ||
9 | * Gated clock implementation | ||
10 | */ | ||
11 | |||
12 | #include <linux/clk-provider.h> | ||
13 | #include <linux/module.h> | ||
14 | #include <linux/slab.h> | ||
15 | #include <linux/io.h> | ||
16 | #include <linux/err.h> | ||
17 | #include <linux/string.h> | ||
18 | |||
19 | /** | ||
20 | * DOC: basic gatable clock which can gate and ungate it's ouput | ||
21 | * | ||
22 | * Traits of this clock: | ||
23 | * prepare - clk_(un)prepare only ensures parent is (un)prepared | ||
24 | * enable - clk_enable and clk_disable are functional & control gating | ||
25 | * rate - inherits rate from parent. No clk_set_rate support | ||
26 | * parent - fixed parent. No clk_set_parent support | ||
27 | */ | ||
28 | |||
29 | #define to_clk_gate(_hw) container_of(_hw, struct clk_gate, hw) | ||
30 | |||
31 | static int clk_gate2_enable(struct clk_hw *hw) | ||
32 | { | ||
33 | struct clk_gate *gate = to_clk_gate(hw); | ||
34 | u32 reg; | ||
35 | unsigned long flags = 0; | ||
36 | |||
37 | if (gate->lock) | ||
38 | spin_lock_irqsave(gate->lock, flags); | ||
39 | |||
40 | reg = readl(gate->reg); | ||
41 | reg |= 3 << gate->bit_idx; | ||
42 | writel(reg, gate->reg); | ||
43 | |||
44 | if (gate->lock) | ||
45 | spin_unlock_irqrestore(gate->lock, flags); | ||
46 | |||
47 | return 0; | ||
48 | } | ||
49 | |||
50 | static void clk_gate2_disable(struct clk_hw *hw) | ||
51 | { | ||
52 | struct clk_gate *gate = to_clk_gate(hw); | ||
53 | u32 reg; | ||
54 | unsigned long flags = 0; | ||
55 | |||
56 | if (gate->lock) | ||
57 | spin_lock_irqsave(gate->lock, flags); | ||
58 | |||
59 | reg = readl(gate->reg); | ||
60 | reg &= ~(3 << gate->bit_idx); | ||
61 | writel(reg, gate->reg); | ||
62 | |||
63 | if (gate->lock) | ||
64 | spin_unlock_irqrestore(gate->lock, flags); | ||
65 | } | ||
66 | |||
67 | static int clk_gate2_is_enabled(struct clk_hw *hw) | ||
68 | { | ||
69 | u32 reg; | ||
70 | struct clk_gate *gate = to_clk_gate(hw); | ||
71 | |||
72 | reg = readl(gate->reg); | ||
73 | |||
74 | if (((reg >> gate->bit_idx) & 3) == 3) | ||
75 | return 1; | ||
76 | |||
77 | return 0; | ||
78 | } | ||
79 | |||
80 | static struct clk_ops clk_gate2_ops = { | ||
81 | .enable = clk_gate2_enable, | ||
82 | .disable = clk_gate2_disable, | ||
83 | .is_enabled = clk_gate2_is_enabled, | ||
84 | }; | ||
85 | |||
86 | struct clk *clk_register_gate2(struct device *dev, const char *name, | ||
87 | const char *parent_name, unsigned long flags, | ||
88 | void __iomem *reg, u8 bit_idx, | ||
89 | u8 clk_gate2_flags, spinlock_t *lock) | ||
90 | { | ||
91 | struct clk_gate *gate; | ||
92 | struct clk *clk; | ||
93 | struct clk_init_data init; | ||
94 | |||
95 | gate = kzalloc(sizeof(struct clk_gate), GFP_KERNEL); | ||
96 | if (!gate) | ||
97 | return ERR_PTR(-ENOMEM); | ||
98 | |||
99 | /* struct clk_gate assignments */ | ||
100 | gate->reg = reg; | ||
101 | gate->bit_idx = bit_idx; | ||
102 | gate->flags = clk_gate2_flags; | ||
103 | gate->lock = lock; | ||
104 | |||
105 | init.name = name; | ||
106 | init.ops = &clk_gate2_ops; | ||
107 | init.flags = flags; | ||
108 | init.parent_names = parent_name ? &parent_name : NULL; | ||
109 | init.num_parents = parent_name ? 1 : 0; | ||
110 | |||
111 | gate->hw.init = &init; | ||
112 | |||
113 | clk = clk_register(dev, &gate->hw); | ||
114 | if (IS_ERR(clk)) | ||
115 | kfree(clk); | ||
116 | |||
117 | return clk; | ||
118 | } | ||
diff --git a/arch/arm/mach-imx/clk-imx1.c b/arch/arm/mach-imx/clk-imx1.c new file mode 100644 index 000000000000..0f0beb580b73 --- /dev/null +++ b/arch/arm/mach-imx/clk-imx1.c | |||
@@ -0,0 +1,115 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2008 Sascha Hauer <s.hauer@pengutronix.de>, Pengutronix | ||
3 | * | ||
4 | * This program is free software; you can redistribute it and/or modify | ||
5 | * it under the terms of the GNU General Public License version 2 as | ||
6 | * published by the Free Software Foundation. | ||
7 | * | ||
8 | * This program is distributed in the hope that it will be useful, | ||
9 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
10 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
11 | * GNU General Public License for more details. | ||
12 | * | ||
13 | * You should have received a copy of the GNU General Public License along | ||
14 | * with this program; if not, write to the Free Software Foundation, Inc., | ||
15 | * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA. | ||
16 | */ | ||
17 | |||
18 | #include <linux/kernel.h> | ||
19 | #include <linux/init.h> | ||
20 | #include <linux/clk.h> | ||
21 | #include <linux/io.h> | ||
22 | #include <linux/clkdev.h> | ||
23 | #include <linux/err.h> | ||
24 | |||
25 | #include <mach/hardware.h> | ||
26 | #include <mach/common.h> | ||
27 | #include "clk.h" | ||
28 | |||
29 | /* CCM register addresses */ | ||
30 | #define IO_ADDR_CCM(off) (MX1_IO_ADDRESS(MX1_CCM_BASE_ADDR + (off))) | ||
31 | |||
32 | #define CCM_CSCR IO_ADDR_CCM(0x0) | ||
33 | #define CCM_MPCTL0 IO_ADDR_CCM(0x4) | ||
34 | #define CCM_SPCTL0 IO_ADDR_CCM(0xc) | ||
35 | #define CCM_PCDR IO_ADDR_CCM(0x20) | ||
36 | |||
37 | /* SCM register addresses */ | ||
38 | #define IO_ADDR_SCM(off) (MX1_IO_ADDRESS(MX1_SCM_BASE_ADDR + (off))) | ||
39 | |||
40 | #define SCM_GCCR IO_ADDR_SCM(0xc) | ||
41 | |||
42 | static const char *prem_sel_clks[] = { "clk32_premult", "clk16m", }; | ||
43 | static const char *clko_sel_clks[] = { "per1", "hclk", "clk48m", "clk16m", "prem", | ||
44 | "fclk", }; | ||
45 | enum imx1_clks { | ||
46 | dummy, clk32, clk16m_ext, clk16m, clk32_premult, prem, mpll, spll, mcu, | ||
47 | fclk, hclk, clk48m, per1, per2, per3, clko, dma_gate, csi_gate, | ||
48 | mma_gate, usbd_gate, clk_max | ||
49 | }; | ||
50 | |||
51 | static struct clk *clk[clk_max]; | ||
52 | |||
53 | int __init mx1_clocks_init(unsigned long fref) | ||
54 | { | ||
55 | int i; | ||
56 | |||
57 | clk[dummy] = imx_clk_fixed("dummy", 0); | ||
58 | clk[clk32] = imx_clk_fixed("clk32", fref); | ||
59 | clk[clk16m_ext] = imx_clk_fixed("clk16m_ext", 16000000); | ||
60 | clk[clk16m] = imx_clk_gate("clk16m", "clk16m_ext", CCM_CSCR, 17); | ||
61 | clk[clk32_premult] = imx_clk_fixed_factor("clk32_premult", "clk32", 512, 1); | ||
62 | clk[prem] = imx_clk_mux("prem", CCM_CSCR, 16, 1, prem_sel_clks, | ||
63 | ARRAY_SIZE(prem_sel_clks)); | ||
64 | clk[mpll] = imx_clk_pllv1("mpll", "clk32_premult", CCM_MPCTL0); | ||
65 | clk[spll] = imx_clk_pllv1("spll", "prem", CCM_SPCTL0); | ||
66 | clk[mcu] = imx_clk_divider("mcu", "clk32_premult", CCM_CSCR, 15, 1); | ||
67 | clk[fclk] = imx_clk_divider("fclk", "mpll", CCM_CSCR, 15, 1); | ||
68 | clk[hclk] = imx_clk_divider("hclk", "spll", CCM_CSCR, 10, 4); | ||
69 | clk[clk48m] = imx_clk_divider("clk48m", "spll", CCM_CSCR, 26, 3); | ||
70 | clk[per1] = imx_clk_divider("per1", "spll", CCM_PCDR, 0, 4); | ||
71 | clk[per2] = imx_clk_divider("per2", "spll", CCM_PCDR, 4, 4); | ||
72 | clk[per3] = imx_clk_divider("per3", "spll", CCM_PCDR, 16, 7); | ||
73 | clk[clko] = imx_clk_mux("clko", CCM_CSCR, 29, 3, clko_sel_clks, | ||
74 | ARRAY_SIZE(clko_sel_clks)); | ||
75 | clk[dma_gate] = imx_clk_gate("dma_gate", "hclk", SCM_GCCR, 4); | ||
76 | clk[csi_gate] = imx_clk_gate("csi_gate", "hclk", SCM_GCCR, 2); | ||
77 | clk[mma_gate] = imx_clk_gate("mma_gate", "hclk", SCM_GCCR, 1); | ||
78 | clk[usbd_gate] = imx_clk_gate("usbd_gate", "clk48m", SCM_GCCR, 0); | ||
79 | |||
80 | for (i = 0; i < ARRAY_SIZE(clk); i++) | ||
81 | if (IS_ERR(clk[i])) | ||
82 | pr_err("imx1 clk %d: register failed with %ld\n", | ||
83 | i, PTR_ERR(clk[i])); | ||
84 | |||
85 | clk_register_clkdev(clk[dma_gate], "ahb", "imx-dma"); | ||
86 | clk_register_clkdev(clk[csi_gate], NULL, "mx1-camera.0"); | ||
87 | clk_register_clkdev(clk[mma_gate], "mma", NULL); | ||
88 | clk_register_clkdev(clk[usbd_gate], NULL, "imx_udc.0"); | ||
89 | clk_register_clkdev(clk[per1], "per", "imx-gpt.0"); | ||
90 | clk_register_clkdev(clk[hclk], "ipg", "imx-gpt.0"); | ||
91 | clk_register_clkdev(clk[per1], "per", "imx1-uart.0"); | ||
92 | clk_register_clkdev(clk[hclk], "ipg", "imx1-uart.0"); | ||
93 | clk_register_clkdev(clk[per1], "per", "imx1-uart.1"); | ||
94 | clk_register_clkdev(clk[hclk], "ipg", "imx1-uart.1"); | ||
95 | clk_register_clkdev(clk[per1], "per", "imx1-uart.2"); | ||
96 | clk_register_clkdev(clk[hclk], "ipg", "imx1-uart.2"); | ||
97 | clk_register_clkdev(clk[hclk], NULL, "imx-i2c.0"); | ||
98 | clk_register_clkdev(clk[per2], "per", "imx1-cspi.0"); | ||
99 | clk_register_clkdev(clk[dummy], "ipg", "imx1-cspi.0"); | ||
100 | clk_register_clkdev(clk[per2], "per", "imx1-cspi.1"); | ||
101 | clk_register_clkdev(clk[dummy], "ipg", "imx1-cspi.1"); | ||
102 | clk_register_clkdev(clk[per2], NULL, "imx-mmc.0"); | ||
103 | clk_register_clkdev(clk[per2], "per", "imx-fb.0"); | ||
104 | clk_register_clkdev(clk[dummy], "ipg", "imx-fb.0"); | ||
105 | clk_register_clkdev(clk[dummy], "ahb", "imx-fb.0"); | ||
106 | clk_register_clkdev(clk[hclk], "mshc", NULL); | ||
107 | clk_register_clkdev(clk[per3], "ssi", NULL); | ||
108 | clk_register_clkdev(clk[clk32], NULL, "mxc_rtc.0"); | ||
109 | clk_register_clkdev(clk[clko], "clko", NULL); | ||
110 | |||
111 | mxc_timer_init(NULL, MX1_IO_ADDRESS(MX1_TIM1_BASE_ADDR), | ||
112 | MX1_TIM1_INT); | ||
113 | |||
114 | return 0; | ||
115 | } | ||
diff --git a/arch/arm/mach-imx/clk-imx21.c b/arch/arm/mach-imx/clk-imx21.c new file mode 100644 index 000000000000..4e4f384ee8dd --- /dev/null +++ b/arch/arm/mach-imx/clk-imx21.c | |||
@@ -0,0 +1,186 @@ | |||
1 | /* | ||
2 | * Copyright 2004-2007 Freescale Semiconductor, Inc. All Rights Reserved. | ||
3 | * Copyright 2008 Juergen Beisert, kernel@pengutronix.de | ||
4 | * Copyright 2008 Martin Fuzzey, mfuzzey@gmail.com | ||
5 | * | ||
6 | * This program is free software; you can redistribute it and/or | ||
7 | * modify it under the terms of the GNU General Public License | ||
8 | * as published by the Free Software Foundation; either version 2 | ||
9 | * of the License, or (at your option) any later version. | ||
10 | * This program is distributed in the hope that it will be useful, | ||
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
13 | * GNU General Public License for more details. | ||
14 | * | ||
15 | * You should have received a copy of the GNU General Public License | ||
16 | * along with this program; if not, write to the Free Software | ||
17 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, | ||
18 | * MA 02110-1301, USA. | ||
19 | */ | ||
20 | |||
21 | #include <linux/clk.h> | ||
22 | #include <linux/clkdev.h> | ||
23 | #include <linux/clk-provider.h> | ||
24 | #include <linux/io.h> | ||
25 | #include <linux/module.h> | ||
26 | #include <linux/clkdev.h> | ||
27 | #include <linux/err.h> | ||
28 | |||
29 | #include <mach/hardware.h> | ||
30 | #include <mach/common.h> | ||
31 | #include "clk.h" | ||
32 | |||
33 | #define IO_ADDR_CCM(off) (MX21_IO_ADDRESS(MX21_CCM_BASE_ADDR + (off))) | ||
34 | |||
35 | /* Register offsets */ | ||
36 | #define CCM_CSCR IO_ADDR_CCM(0x0) | ||
37 | #define CCM_MPCTL0 IO_ADDR_CCM(0x4) | ||
38 | #define CCM_MPCTL1 IO_ADDR_CCM(0x8) | ||
39 | #define CCM_SPCTL0 IO_ADDR_CCM(0xc) | ||
40 | #define CCM_SPCTL1 IO_ADDR_CCM(0x10) | ||
41 | #define CCM_OSC26MCTL IO_ADDR_CCM(0x14) | ||
42 | #define CCM_PCDR0 IO_ADDR_CCM(0x18) | ||
43 | #define CCM_PCDR1 IO_ADDR_CCM(0x1c) | ||
44 | #define CCM_PCCR0 IO_ADDR_CCM(0x20) | ||
45 | #define CCM_PCCR1 IO_ADDR_CCM(0x24) | ||
46 | #define CCM_CCSR IO_ADDR_CCM(0x28) | ||
47 | #define CCM_PMCTL IO_ADDR_CCM(0x2c) | ||
48 | #define CCM_PMCOUNT IO_ADDR_CCM(0x30) | ||
49 | #define CCM_WKGDCTL IO_ADDR_CCM(0x34) | ||
50 | |||
51 | static const char *mpll_sel_clks[] = { "fpm", "ckih", }; | ||
52 | static const char *spll_sel_clks[] = { "fpm", "ckih", }; | ||
53 | |||
54 | enum imx21_clks { | ||
55 | ckil, ckih, fpm, mpll_sel, spll_sel, mpll, spll, fclk, hclk, ipg, per1, | ||
56 | per2, per3, per4, uart1_ipg_gate, uart2_ipg_gate, uart3_ipg_gate, | ||
57 | uart4_ipg_gate, gpt1_ipg_gate, gpt2_ipg_gate, gpt3_ipg_gate, | ||
58 | pwm_ipg_gate, sdhc1_ipg_gate, sdhc2_ipg_gate, lcdc_ipg_gate, | ||
59 | lcdc_hclk_gate, cspi3_ipg_gate, cspi2_ipg_gate, cspi1_ipg_gate, | ||
60 | per4_gate, csi_hclk_gate, usb_div, usb_gate, usb_hclk_gate, ssi1_gate, | ||
61 | ssi2_gate, nfc_div, nfc_gate, dma_gate, dma_hclk_gate, brom_gate, | ||
62 | emma_gate, emma_hclk_gate, slcdc_gate, slcdc_hclk_gate, wdog_gate, | ||
63 | gpio_gate, i2c_gate, kpp_gate, owire_gate, rtc_gate, clk_max | ||
64 | }; | ||
65 | |||
66 | static struct clk *clk[clk_max]; | ||
67 | |||
68 | /* | ||
69 | * must be called very early to get information about the | ||
70 | * available clock rate when the timer framework starts | ||
71 | */ | ||
72 | int __init mx21_clocks_init(unsigned long lref, unsigned long href) | ||
73 | { | ||
74 | int i; | ||
75 | |||
76 | clk[ckil] = imx_clk_fixed("ckil", lref); | ||
77 | clk[ckih] = imx_clk_fixed("ckih", href); | ||
78 | clk[fpm] = imx_clk_fixed_factor("fpm", "ckil", 512, 1); | ||
79 | clk[mpll_sel] = imx_clk_mux("mpll_sel", CCM_CSCR, 16, 1, mpll_sel_clks, | ||
80 | ARRAY_SIZE(mpll_sel_clks)); | ||
81 | clk[spll_sel] = imx_clk_mux("spll_sel", CCM_CSCR, 17, 1, spll_sel_clks, | ||
82 | ARRAY_SIZE(spll_sel_clks)); | ||
83 | clk[mpll] = imx_clk_pllv1("mpll", "mpll_sel", CCM_MPCTL0); | ||
84 | clk[spll] = imx_clk_pllv1("spll", "spll_sel", CCM_SPCTL0); | ||
85 | clk[fclk] = imx_clk_divider("fclk", "mpll", CCM_CSCR, 29, 3); | ||
86 | clk[hclk] = imx_clk_divider("hclk", "fclk", CCM_CSCR, 10, 4); | ||
87 | clk[ipg] = imx_clk_divider("ipg", "hclk", CCM_CSCR, 9, 1); | ||
88 | clk[per1] = imx_clk_divider("per1", "mpll", CCM_PCDR1, 0, 6); | ||
89 | clk[per2] = imx_clk_divider("per2", "mpll", CCM_PCDR1, 8, 6); | ||
90 | clk[per3] = imx_clk_divider("per3", "mpll", CCM_PCDR1, 16, 6); | ||
91 | clk[per4] = imx_clk_divider("per4", "mpll", CCM_PCDR1, 24, 6); | ||
92 | clk[uart1_ipg_gate] = imx_clk_gate("uart1_ipg_gate", "ipg", CCM_PCCR0, 0); | ||
93 | clk[uart2_ipg_gate] = imx_clk_gate("uart2_ipg_gate", "ipg", CCM_PCCR0, 1); | ||
94 | clk[uart3_ipg_gate] = imx_clk_gate("uart3_ipg_gate", "ipg", CCM_PCCR0, 2); | ||
95 | clk[uart4_ipg_gate] = imx_clk_gate("uart4_ipg_gate", "ipg", CCM_PCCR0, 3); | ||
96 | clk[gpt1_ipg_gate] = imx_clk_gate("gpt1_ipg_gate", "ipg", CCM_PCCR1, 25); | ||
97 | clk[gpt2_ipg_gate] = imx_clk_gate("gpt2_ipg_gate", "ipg", CCM_PCCR1, 26); | ||
98 | clk[gpt3_ipg_gate] = imx_clk_gate("gpt3_ipg_gate", "ipg", CCM_PCCR1, 27); | ||
99 | clk[pwm_ipg_gate] = imx_clk_gate("pwm_ipg_gate", "ipg", CCM_PCCR1, 28); | ||
100 | clk[sdhc1_ipg_gate] = imx_clk_gate("sdhc1_ipg_gate", "ipg", CCM_PCCR0, 9); | ||
101 | clk[sdhc2_ipg_gate] = imx_clk_gate("sdhc2_ipg_gate", "ipg", CCM_PCCR0, 10); | ||
102 | clk[lcdc_ipg_gate] = imx_clk_gate("lcdc_ipg_gate", "ipg", CCM_PCCR0, 18); | ||
103 | clk[lcdc_hclk_gate] = imx_clk_gate("lcdc_hclk_gate", "hclk", CCM_PCCR0, 26); | ||
104 | clk[cspi3_ipg_gate] = imx_clk_gate("cspi3_ipg_gate", "ipg", CCM_PCCR1, 23); | ||
105 | clk[cspi2_ipg_gate] = imx_clk_gate("cspi2_ipg_gate", "ipg", CCM_PCCR0, 5); | ||
106 | clk[cspi1_ipg_gate] = imx_clk_gate("cspi1_ipg_gate", "ipg", CCM_PCCR0, 4); | ||
107 | clk[per4_gate] = imx_clk_gate("per4_gate", "per4", CCM_PCCR0, 22); | ||
108 | clk[csi_hclk_gate] = imx_clk_gate("csi_hclk_gate", "hclk", CCM_PCCR0, 31); | ||
109 | clk[usb_div] = imx_clk_divider("usb_div", "spll", CCM_CSCR, 26, 3); | ||
110 | clk[usb_gate] = imx_clk_gate("usb_gate", "usb_div", CCM_PCCR0, 14); | ||
111 | clk[usb_hclk_gate] = imx_clk_gate("usb_hclk_gate", "hclk", CCM_PCCR0, 24); | ||
112 | clk[ssi1_gate] = imx_clk_gate("ssi1_gate", "ipg", CCM_PCCR0, 6); | ||
113 | clk[ssi2_gate] = imx_clk_gate("ssi2_gate", "ipg", CCM_PCCR0, 7); | ||
114 | clk[nfc_div] = imx_clk_divider("nfc_div", "ipg", CCM_PCDR0, 12, 4); | ||
115 | clk[nfc_gate] = imx_clk_gate("nfc_gate", "nfc_div", CCM_PCCR0, 19); | ||
116 | clk[dma_gate] = imx_clk_gate("dma_gate", "ipg", CCM_PCCR0, 13); | ||
117 | clk[dma_hclk_gate] = imx_clk_gate("dma_hclk_gate", "hclk", CCM_PCCR0, 30); | ||
118 | clk[brom_gate] = imx_clk_gate("brom_gate", "hclk", CCM_PCCR0, 28); | ||
119 | clk[emma_gate] = imx_clk_gate("emma_gate", "ipg", CCM_PCCR0, 15); | ||
120 | clk[emma_hclk_gate] = imx_clk_gate("emma_hclk_gate", "hclk", CCM_PCCR0, 27); | ||
121 | clk[slcdc_gate] = imx_clk_gate("slcdc_gate", "ipg", CCM_PCCR0, 25); | ||
122 | clk[slcdc_hclk_gate] = imx_clk_gate("slcdc_hclk_gate", "hclk", CCM_PCCR0, 21); | ||
123 | clk[wdog_gate] = imx_clk_gate("wdog_gate", "ipg", CCM_PCCR1, 24); | ||
124 | clk[gpio_gate] = imx_clk_gate("gpio_gate", "ipg", CCM_PCCR0, 11); | ||
125 | clk[i2c_gate] = imx_clk_gate("i2c_gate", "ipg", CCM_PCCR0, 12); | ||
126 | clk[kpp_gate] = imx_clk_gate("kpp_gate", "ipg", CCM_PCCR1, 30); | ||
127 | clk[owire_gate] = imx_clk_gate("owire_gate", "ipg", CCM_PCCR1, 31); | ||
128 | clk[rtc_gate] = imx_clk_gate("rtc_gate", "ipg", CCM_PCCR1, 29); | ||
129 | |||
130 | for (i = 0; i < ARRAY_SIZE(clk); i++) | ||
131 | if (IS_ERR(clk[i])) | ||
132 | pr_err("i.MX21 clk %d: register failed with %ld\n", | ||
133 | i, PTR_ERR(clk[i])); | ||
134 | |||
135 | clk_register_clkdev(clk[per1], "per1", NULL); | ||
136 | clk_register_clkdev(clk[per2], "per2", NULL); | ||
137 | clk_register_clkdev(clk[per3], "per3", NULL); | ||
138 | clk_register_clkdev(clk[per4], "per4", NULL); | ||
139 | clk_register_clkdev(clk[per1], "per", "imx21-uart.0"); | ||
140 | clk_register_clkdev(clk[uart1_ipg_gate], "ipg", "imx21-uart.0"); | ||
141 | clk_register_clkdev(clk[per1], "per", "imx21-uart.1"); | ||
142 | clk_register_clkdev(clk[uart2_ipg_gate], "ipg", "imx21-uart.1"); | ||
143 | clk_register_clkdev(clk[per1], "per", "imx21-uart.2"); | ||
144 | clk_register_clkdev(clk[uart3_ipg_gate], "ipg", "imx21-uart.2"); | ||
145 | clk_register_clkdev(clk[per1], "per", "imx21-uart.3"); | ||
146 | clk_register_clkdev(clk[uart4_ipg_gate], "ipg", "imx21-uart.3"); | ||
147 | clk_register_clkdev(clk[gpt1_ipg_gate], "ipg", "imx-gpt.0"); | ||
148 | clk_register_clkdev(clk[per1], "per", "imx-gpt.0"); | ||
149 | clk_register_clkdev(clk[gpt2_ipg_gate], "ipg", "imx-gpt.1"); | ||
150 | clk_register_clkdev(clk[per1], "per", "imx-gpt.1"); | ||
151 | clk_register_clkdev(clk[gpt3_ipg_gate], "ipg", "imx-gpt.2"); | ||
152 | clk_register_clkdev(clk[per1], "per", "imx-gpt.2"); | ||
153 | clk_register_clkdev(clk[pwm_ipg_gate], "pwm", "mxc_pwm.0"); | ||
154 | clk_register_clkdev(clk[per2], "per", "imx21-cspi.0"); | ||
155 | clk_register_clkdev(clk[cspi1_ipg_gate], "ipg", "imx21-cspi.0"); | ||
156 | clk_register_clkdev(clk[per2], "per", "imx21-cspi.1"); | ||
157 | clk_register_clkdev(clk[cspi2_ipg_gate], "ipg", "imx21-cspi.1"); | ||
158 | clk_register_clkdev(clk[per2], "per", "imx21-cspi.2"); | ||
159 | clk_register_clkdev(clk[cspi3_ipg_gate], "ipg", "imx21-cspi.2"); | ||
160 | clk_register_clkdev(clk[per3], "per", "imx-fb.0"); | ||
161 | clk_register_clkdev(clk[lcdc_ipg_gate], "ipg", "imx-fb.0"); | ||
162 | clk_register_clkdev(clk[lcdc_hclk_gate], "ahb", "imx-fb.0"); | ||
163 | clk_register_clkdev(clk[usb_gate], "per", "imx21-hcd.0"); | ||
164 | clk_register_clkdev(clk[usb_hclk_gate], "ahb", "imx21-hcd.0"); | ||
165 | clk_register_clkdev(clk[nfc_gate], NULL, "mxc_nand.0"); | ||
166 | clk_register_clkdev(clk[dma_hclk_gate], "ahb", "imx-dma"); | ||
167 | clk_register_clkdev(clk[dma_gate], "ipg", "imx-dma"); | ||
168 | clk_register_clkdev(clk[wdog_gate], NULL, "imx2-wdt.0"); | ||
169 | clk_register_clkdev(clk[i2c_gate], NULL, "imx-i2c.0"); | ||
170 | clk_register_clkdev(clk[kpp_gate], NULL, "mxc-keypad"); | ||
171 | clk_register_clkdev(clk[owire_gate], NULL, "mxc_w1.0"); | ||
172 | clk_register_clkdev(clk[brom_gate], "brom", NULL); | ||
173 | clk_register_clkdev(clk[emma_gate], "emma", NULL); | ||
174 | clk_register_clkdev(clk[slcdc_gate], "slcdc", NULL); | ||
175 | clk_register_clkdev(clk[gpio_gate], "gpio", NULL); | ||
176 | clk_register_clkdev(clk[rtc_gate], "rtc", NULL); | ||
177 | clk_register_clkdev(clk[csi_hclk_gate], "csi", NULL); | ||
178 | clk_register_clkdev(clk[ssi1_gate], "ssi1", NULL); | ||
179 | clk_register_clkdev(clk[ssi2_gate], "ssi2", NULL); | ||
180 | clk_register_clkdev(clk[sdhc1_ipg_gate], "sdhc1", NULL); | ||
181 | clk_register_clkdev(clk[sdhc2_ipg_gate], "sdhc2", NULL); | ||
182 | |||
183 | mxc_timer_init(NULL, MX21_IO_ADDRESS(MX21_GPT1_BASE_ADDR), | ||
184 | MX21_INT_GPT1); | ||
185 | return 0; | ||
186 | } | ||
diff --git a/arch/arm/mach-imx/clk-imx25.c b/arch/arm/mach-imx/clk-imx25.c new file mode 100644 index 000000000000..d9833bb5fd61 --- /dev/null +++ b/arch/arm/mach-imx/clk-imx25.c | |||
@@ -0,0 +1,248 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2009 by Sascha Hauer, Pengutronix | ||
3 | * | ||
4 | * This program is free software; you can redistribute it and/or | ||
5 | * modify it under the terms of the GNU General Public License | ||
6 | * as published by the Free Software Foundation; either version 2 | ||
7 | * of the License, or (at your option) any later version. | ||
8 | * This program is distributed in the hope that it will be useful, | ||
9 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
10 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
11 | * GNU General Public License for more details. | ||
12 | * | ||
13 | * You should have received a copy of the GNU General Public License | ||
14 | * along with this program; if not, write to the Free Software | ||
15 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, | ||
16 | * MA 02110-1301, USA. | ||
17 | */ | ||
18 | |||
19 | #include <linux/kernel.h> | ||
20 | #include <linux/init.h> | ||
21 | #include <linux/list.h> | ||
22 | #include <linux/clk.h> | ||
23 | #include <linux/io.h> | ||
24 | #include <linux/clkdev.h> | ||
25 | #include <linux/err.h> | ||
26 | |||
27 | #include <mach/hardware.h> | ||
28 | #include <mach/common.h> | ||
29 | #include <mach/mx25.h> | ||
30 | #include "clk.h" | ||
31 | |||
32 | #define CRM_BASE MX25_IO_ADDRESS(MX25_CRM_BASE_ADDR) | ||
33 | |||
34 | #define CCM_MPCTL 0x00 | ||
35 | #define CCM_UPCTL 0x04 | ||
36 | #define CCM_CCTL 0x08 | ||
37 | #define CCM_CGCR0 0x0C | ||
38 | #define CCM_CGCR1 0x10 | ||
39 | #define CCM_CGCR2 0x14 | ||
40 | #define CCM_PCDR0 0x18 | ||
41 | #define CCM_PCDR1 0x1C | ||
42 | #define CCM_PCDR2 0x20 | ||
43 | #define CCM_PCDR3 0x24 | ||
44 | #define CCM_RCSR 0x28 | ||
45 | #define CCM_CRDR 0x2C | ||
46 | #define CCM_DCVR0 0x30 | ||
47 | #define CCM_DCVR1 0x34 | ||
48 | #define CCM_DCVR2 0x38 | ||
49 | #define CCM_DCVR3 0x3c | ||
50 | #define CCM_LTR0 0x40 | ||
51 | #define CCM_LTR1 0x44 | ||
52 | #define CCM_LTR2 0x48 | ||
53 | #define CCM_LTR3 0x4c | ||
54 | #define CCM_MCR 0x64 | ||
55 | |||
56 | #define ccm(x) (CRM_BASE + (x)) | ||
57 | |||
58 | static const char *cpu_sel_clks[] = { "mpll", "mpll_cpu_3_4", }; | ||
59 | static const char *per_sel_clks[] = { "ahb", "upll", }; | ||
60 | |||
61 | enum mx25_clks { | ||
62 | dummy, osc, mpll, upll, mpll_cpu_3_4, cpu_sel, cpu, ahb, usb_div, ipg, | ||
63 | per0_sel, per1_sel, per2_sel, per3_sel, per4_sel, per5_sel, per6_sel, | ||
64 | per7_sel, per8_sel, per9_sel, per10_sel, per11_sel, per12_sel, | ||
65 | per13_sel, per14_sel, per15_sel, per0, per1, per2, per3, per4, per5, | ||
66 | per6, per7, per8, per9, per10, per11, per12, per13, per14, per15, | ||
67 | csi_ipg_per, esdhc1_ipg_per, esdhc2_ipg_per, gpt_ipg_per, i2c_ipg_per, | ||
68 | lcdc_ipg_per, nfc_ipg_per, ssi1_ipg_per, ssi2_ipg_per, uart_ipg_per, | ||
69 | csi_ahb, esdhc1_ahb, esdhc2_ahb, fec_ahb, lcdc_ahb, sdma_ahb, | ||
70 | usbotg_ahb, can1_ipg, can2_ipg, csi_ipg, cspi1_ipg, cspi2_ipg, | ||
71 | cspi3_ipg, dryice_ipg, esdhc1_ipg, esdhc2_ipg, fec_ipg, iim_ipg, | ||
72 | kpp_ipg, lcdc_ipg, pwm1_ipg, pwm2_ipg, pwm3_ipg, pwm4_ipg, sdma_ipg, | ||
73 | ssi1_ipg, ssi2_ipg, tsc_ipg, uart1_ipg, uart2_ipg, uart3_ipg, | ||
74 | uart4_ipg, uart5_ipg, wdt_ipg, clk_max | ||
75 | }; | ||
76 | |||
77 | static struct clk *clk[clk_max]; | ||
78 | |||
79 | int __init mx25_clocks_init(void) | ||
80 | { | ||
81 | int i; | ||
82 | |||
83 | clk[dummy] = imx_clk_fixed("dummy", 0); | ||
84 | clk[osc] = imx_clk_fixed("osc", 24000000); | ||
85 | clk[mpll] = imx_clk_pllv1("mpll", "osc", ccm(CCM_MPCTL)); | ||
86 | clk[upll] = imx_clk_pllv1("upll", "osc", ccm(CCM_UPCTL)); | ||
87 | clk[mpll_cpu_3_4] = imx_clk_fixed_factor("mpll_cpu_3_4", "mpll", 3, 4); | ||
88 | clk[cpu_sel] = imx_clk_mux("cpu_sel", ccm(CCM_CCTL), 14, 1, cpu_sel_clks, ARRAY_SIZE(cpu_sel_clks)); | ||
89 | clk[cpu] = imx_clk_divider("cpu", "cpu_sel", ccm(CCM_CCTL), 30, 2); | ||
90 | clk[ahb] = imx_clk_divider("ahb", "cpu", ccm(CCM_CCTL), 28, 2); | ||
91 | clk[usb_div] = imx_clk_divider("usb_div", "upll", ccm(CCM_CCTL), 16, 6); | ||
92 | clk[ipg] = imx_clk_fixed_factor("ipg", "ahb", 1, 2); | ||
93 | clk[per0_sel] = imx_clk_mux("per0_sel", ccm(CCM_MCR), 0, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
94 | clk[per1_sel] = imx_clk_mux("per1_sel", ccm(CCM_MCR), 1, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
95 | clk[per2_sel] = imx_clk_mux("per2_sel", ccm(CCM_MCR), 2, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
96 | clk[per3_sel] = imx_clk_mux("per3_sel", ccm(CCM_MCR), 3, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
97 | clk[per4_sel] = imx_clk_mux("per4_sel", ccm(CCM_MCR), 4, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
98 | clk[per5_sel] = imx_clk_mux("per5_sel", ccm(CCM_MCR), 5, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
99 | clk[per6_sel] = imx_clk_mux("per6_sel", ccm(CCM_MCR), 6, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
100 | clk[per7_sel] = imx_clk_mux("per7_sel", ccm(CCM_MCR), 7, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
101 | clk[per8_sel] = imx_clk_mux("per8_sel", ccm(CCM_MCR), 8, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
102 | clk[per9_sel] = imx_clk_mux("per9_sel", ccm(CCM_MCR), 9, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
103 | clk[per10_sel] = imx_clk_mux("per10_sel", ccm(CCM_MCR), 10, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
104 | clk[per11_sel] = imx_clk_mux("per11_sel", ccm(CCM_MCR), 11, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
105 | clk[per12_sel] = imx_clk_mux("per12_sel", ccm(CCM_MCR), 12, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
106 | clk[per13_sel] = imx_clk_mux("per13_sel", ccm(CCM_MCR), 13, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
107 | clk[per14_sel] = imx_clk_mux("per14_sel", ccm(CCM_MCR), 14, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
108 | clk[per15_sel] = imx_clk_mux("per15_sel", ccm(CCM_MCR), 15, 1, per_sel_clks, ARRAY_SIZE(per_sel_clks)); | ||
109 | clk[per0] = imx_clk_divider("per0", "per0_sel", ccm(CCM_PCDR0), 0, 6); | ||
110 | clk[per1] = imx_clk_divider("per1", "per1_sel", ccm(CCM_PCDR0), 8, 6); | ||
111 | clk[per2] = imx_clk_divider("per2", "per2_sel", ccm(CCM_PCDR0), 16, 6); | ||
112 | clk[per3] = imx_clk_divider("per3", "per3_sel", ccm(CCM_PCDR0), 24, 6); | ||
113 | clk[per4] = imx_clk_divider("per4", "per4_sel", ccm(CCM_PCDR1), 0, 6); | ||
114 | clk[per5] = imx_clk_divider("per5", "per5_sel", ccm(CCM_PCDR1), 8, 6); | ||
115 | clk[per6] = imx_clk_divider("per6", "per6_sel", ccm(CCM_PCDR1), 16, 6); | ||
116 | clk[per7] = imx_clk_divider("per7", "per7_sel", ccm(CCM_PCDR1), 24, 6); | ||
117 | clk[per8] = imx_clk_divider("per8", "per8_sel", ccm(CCM_PCDR2), 0, 6); | ||
118 | clk[per9] = imx_clk_divider("per9", "per9_sel", ccm(CCM_PCDR2), 8, 6); | ||
119 | clk[per10] = imx_clk_divider("per10", "per10_sel", ccm(CCM_PCDR2), 16, 6); | ||
120 | clk[per11] = imx_clk_divider("per11", "per11_sel", ccm(CCM_PCDR2), 24, 6); | ||
121 | clk[per12] = imx_clk_divider("per12", "per12_sel", ccm(CCM_PCDR3), 0, 6); | ||
122 | clk[per13] = imx_clk_divider("per13", "per13_sel", ccm(CCM_PCDR3), 8, 6); | ||
123 | clk[per14] = imx_clk_divider("per14", "per14_sel", ccm(CCM_PCDR3), 16, 6); | ||
124 | clk[per15] = imx_clk_divider("per15", "per15_sel", ccm(CCM_PCDR3), 24, 6); | ||
125 | clk[csi_ipg_per] = imx_clk_gate("csi_ipg_per", "per0", ccm(CCM_CGCR0), 0); | ||
126 | clk[esdhc1_ipg_per] = imx_clk_gate("esdhc1_ipg_per", "per3", ccm(CCM_CGCR0), 3); | ||
127 | clk[esdhc2_ipg_per] = imx_clk_gate("esdhc2_ipg_per", "per4", ccm(CCM_CGCR0), 4); | ||
128 | clk[gpt_ipg_per] = imx_clk_gate("gpt_ipg_per", "per5", ccm(CCM_CGCR0), 5); | ||
129 | clk[i2c_ipg_per] = imx_clk_gate("i2c_ipg_per", "per6", ccm(CCM_CGCR0), 6); | ||
130 | clk[lcdc_ipg_per] = imx_clk_gate("lcdc_ipg_per", "per8", ccm(CCM_CGCR0), 7); | ||
131 | clk[nfc_ipg_per] = imx_clk_gate("nfc_ipg_per", "ipg_per", ccm(CCM_CGCR0), 8); | ||
132 | clk[ssi1_ipg_per] = imx_clk_gate("ssi1_ipg_per", "per13", ccm(CCM_CGCR0), 13); | ||
133 | clk[ssi2_ipg_per] = imx_clk_gate("ssi2_ipg_per", "per14", ccm(CCM_CGCR0), 14); | ||
134 | clk[uart_ipg_per] = imx_clk_gate("uart_ipg_per", "per15", ccm(CCM_CGCR0), 15); | ||
135 | clk[csi_ahb] = imx_clk_gate("csi_ahb", "ahb", ccm(CCM_CGCR0), 18); | ||
136 | clk[esdhc1_ahb] = imx_clk_gate("esdhc1_ahb", "ahb", ccm(CCM_CGCR0), 21); | ||
137 | clk[esdhc2_ahb] = imx_clk_gate("esdhc2_ahb", "ahb", ccm(CCM_CGCR0), 22); | ||
138 | clk[fec_ahb] = imx_clk_gate("fec_ahb", "ahb", ccm(CCM_CGCR0), 23); | ||
139 | clk[lcdc_ahb] = imx_clk_gate("lcdc_ahb", "ahb", ccm(CCM_CGCR0), 24); | ||
140 | clk[sdma_ahb] = imx_clk_gate("sdma_ahb", "ahb", ccm(CCM_CGCR0), 26); | ||
141 | clk[usbotg_ahb] = imx_clk_gate("usbotg_ahb", "ahb", ccm(CCM_CGCR0), 28); | ||
142 | clk[can1_ipg] = imx_clk_gate("can1_ipg", "ipg", ccm(CCM_CGCR1), 2); | ||
143 | clk[can2_ipg] = imx_clk_gate("can2_ipg", "ipg", ccm(CCM_CGCR1), 3); | ||
144 | clk[csi_ipg] = imx_clk_gate("csi_ipg", "ipg", ccm(CCM_CGCR1), 4); | ||
145 | clk[cspi1_ipg] = imx_clk_gate("cspi1_ipg", "ipg", ccm(CCM_CGCR1), 5); | ||
146 | clk[cspi2_ipg] = imx_clk_gate("cspi2_ipg", "ipg", ccm(CCM_CGCR1), 6); | ||
147 | clk[cspi3_ipg] = imx_clk_gate("cspi3_ipg", "ipg", ccm(CCM_CGCR1), 7); | ||
148 | clk[dryice_ipg] = imx_clk_gate("dryice_ipg", "ipg", ccm(CCM_CGCR1), 8); | ||
149 | clk[esdhc1_ipg] = imx_clk_gate("esdhc1_ipg", "ipg", ccm(CCM_CGCR1), 13); | ||
150 | clk[esdhc2_ipg] = imx_clk_gate("esdhc2_ipg", "ipg", ccm(CCM_CGCR1), 14); | ||
151 | clk[fec_ipg] = imx_clk_gate("fec_ipg", "ipg", ccm(CCM_CGCR1), 15); | ||
152 | clk[iim_ipg] = imx_clk_gate("iim_ipg", "ipg", ccm(CCM_CGCR1), 26); | ||
153 | clk[kpp_ipg] = imx_clk_gate("kpp_ipg", "ipg", ccm(CCM_CGCR1), 28); | ||
154 | clk[lcdc_ipg] = imx_clk_gate("lcdc_ipg", "ipg", ccm(CCM_CGCR1), 29); | ||
155 | clk[pwm1_ipg] = imx_clk_gate("pwm1_ipg", "ipg", ccm(CCM_CGCR1), 31); | ||
156 | clk[pwm2_ipg] = imx_clk_gate("pwm2_ipg", "ipg", ccm(CCM_CGCR2), 0); | ||
157 | clk[pwm3_ipg] = imx_clk_gate("pwm3_ipg", "ipg", ccm(CCM_CGCR2), 1); | ||
158 | clk[pwm4_ipg] = imx_clk_gate("pwm4_ipg", "ipg", ccm(CCM_CGCR2), 2); | ||
159 | clk[sdma_ipg] = imx_clk_gate("sdma_ipg", "ipg", ccm(CCM_CGCR2), 6); | ||
160 | clk[ssi1_ipg] = imx_clk_gate("ssi1_ipg", "ipg", ccm(CCM_CGCR2), 11); | ||
161 | clk[ssi2_ipg] = imx_clk_gate("ssi2_ipg", "ipg", ccm(CCM_CGCR2), 12); | ||
162 | clk[tsc_ipg] = imx_clk_gate("tsc_ipg", "ipg", ccm(CCM_CGCR2), 13); | ||
163 | clk[uart1_ipg] = imx_clk_gate("uart1_ipg", "ipg", ccm(CCM_CGCR2), 14); | ||
164 | clk[uart2_ipg] = imx_clk_gate("uart2_ipg", "ipg", ccm(CCM_CGCR2), 15); | ||
165 | clk[uart3_ipg] = imx_clk_gate("uart3_ipg", "ipg", ccm(CCM_CGCR2), 16); | ||
166 | clk[uart4_ipg] = imx_clk_gate("uart4_ipg", "ipg", ccm(CCM_CGCR2), 17); | ||
167 | clk[uart5_ipg] = imx_clk_gate("uart5_ipg", "ipg", ccm(CCM_CGCR2), 18); | ||
168 | clk[wdt_ipg] = imx_clk_gate("wdt_ipg", "ipg", ccm(CCM_CGCR2), 19); | ||
169 | |||
170 | for (i = 0; i < ARRAY_SIZE(clk); i++) | ||
171 | if (IS_ERR(clk[i])) | ||
172 | pr_err("i.MX25 clk %d: register failed with %ld\n", | ||
173 | i, PTR_ERR(clk[i])); | ||
174 | |||
175 | /* i.mx25 has the i.mx21 type uart */ | ||
176 | clk_register_clkdev(clk[uart1_ipg], "ipg", "imx21-uart.0"); | ||
177 | clk_register_clkdev(clk[uart_ipg_per], "per", "imx21-uart.0"); | ||
178 | clk_register_clkdev(clk[uart2_ipg], "ipg", "imx21-uart.1"); | ||
179 | clk_register_clkdev(clk[uart_ipg_per], "per", "imx21-uart.1"); | ||
180 | clk_register_clkdev(clk[uart3_ipg], "ipg", "imx21-uart.2"); | ||
181 | clk_register_clkdev(clk[uart_ipg_per], "per", "imx21-uart.2"); | ||
182 | clk_register_clkdev(clk[uart4_ipg], "ipg", "imx21-uart.3"); | ||
183 | clk_register_clkdev(clk[uart_ipg_per], "per", "imx21-uart.3"); | ||
184 | clk_register_clkdev(clk[uart5_ipg], "ipg", "imx21-uart.4"); | ||
185 | clk_register_clkdev(clk[uart_ipg_per], "per", "imx21-uart.4"); | ||
186 | clk_register_clkdev(clk[ipg], "ipg", "imx-gpt.0"); | ||
187 | clk_register_clkdev(clk[gpt_ipg_per], "per", "imx-gpt.0"); | ||
188 | clk_register_clkdev(clk[ipg], "ipg", "mxc-ehci.0"); | ||
189 | clk_register_clkdev(clk[usbotg_ahb], "ahb", "mxc-ehci.0"); | ||
190 | clk_register_clkdev(clk[usb_div], "per", "mxc-ehci.0"); | ||
191 | clk_register_clkdev(clk[ipg], "ipg", "mxc-ehci.1"); | ||
192 | clk_register_clkdev(clk[usbotg_ahb], "ahb", "mxc-ehci.1"); | ||
193 | clk_register_clkdev(clk[usb_div], "per", "mxc-ehci.1"); | ||
194 | clk_register_clkdev(clk[ipg], "ipg", "mxc-ehci.2"); | ||
195 | clk_register_clkdev(clk[usbotg_ahb], "ahb", "mxc-ehci.2"); | ||
196 | clk_register_clkdev(clk[usb_div], "per", "mxc-ehci.2"); | ||
197 | clk_register_clkdev(clk[ipg], "ipg", "fsl-usb2-udc"); | ||
198 | clk_register_clkdev(clk[usbotg_ahb], "ahb", "fsl-usb2-udc"); | ||
199 | clk_register_clkdev(clk[usb_div], "per", "fsl-usb2-udc"); | ||
200 | clk_register_clkdev(clk[nfc_ipg_per], NULL, "mxc_nand.0"); | ||
201 | /* i.mx25 has the i.mx35 type cspi */ | ||
202 | clk_register_clkdev(clk[cspi1_ipg], NULL, "imx35-cspi.0"); | ||
203 | clk_register_clkdev(clk[cspi2_ipg], NULL, "imx35-cspi.1"); | ||
204 | clk_register_clkdev(clk[cspi3_ipg], NULL, "imx35-cspi.2"); | ||
205 | clk_register_clkdev(clk[pwm1_ipg], "ipg", "mxc_pwm.0"); | ||
206 | clk_register_clkdev(clk[per10], "per", "mxc_pwm.0"); | ||
207 | clk_register_clkdev(clk[pwm1_ipg], "ipg", "mxc_pwm.1"); | ||
208 | clk_register_clkdev(clk[per10], "per", "mxc_pwm.1"); | ||
209 | clk_register_clkdev(clk[pwm1_ipg], "ipg", "mxc_pwm.2"); | ||
210 | clk_register_clkdev(clk[per10], "per", "mxc_pwm.2"); | ||
211 | clk_register_clkdev(clk[pwm1_ipg], "ipg", "mxc_pwm.3"); | ||
212 | clk_register_clkdev(clk[per10], "per", "mxc_pwm.3"); | ||
213 | clk_register_clkdev(clk[kpp_ipg], NULL, "imx-keypad"); | ||
214 | clk_register_clkdev(clk[tsc_ipg], NULL, "mx25-adc"); | ||
215 | clk_register_clkdev(clk[i2c_ipg_per], NULL, "imx-i2c.0"); | ||
216 | clk_register_clkdev(clk[i2c_ipg_per], NULL, "imx-i2c.1"); | ||
217 | clk_register_clkdev(clk[i2c_ipg_per], NULL, "imx-i2c.2"); | ||
218 | clk_register_clkdev(clk[fec_ipg], "ipg", "imx25-fec.0"); | ||
219 | clk_register_clkdev(clk[fec_ahb], "ahb", "imx25-fec.0"); | ||
220 | clk_register_clkdev(clk[dryice_ipg], NULL, "imxdi_rtc.0"); | ||
221 | clk_register_clkdev(clk[lcdc_ipg_per], "per", "imx-fb.0"); | ||
222 | clk_register_clkdev(clk[lcdc_ipg], "ipg", "imx-fb.0"); | ||
223 | clk_register_clkdev(clk[lcdc_ahb], "ahb", "imx-fb.0"); | ||
224 | clk_register_clkdev(clk[wdt_ipg], NULL, "imx2-wdt.0"); | ||
225 | clk_register_clkdev(clk[ssi1_ipg_per], "per", "imx-ssi.0"); | ||
226 | clk_register_clkdev(clk[ssi1_ipg], "ipg", "imx-ssi.0"); | ||
227 | clk_register_clkdev(clk[ssi2_ipg_per], "per", "imx-ssi.1"); | ||
228 | clk_register_clkdev(clk[ssi2_ipg], "ipg", "imx-ssi.1"); | ||
229 | clk_register_clkdev(clk[esdhc1_ipg_per], "per", "sdhci-esdhc-imx25.0"); | ||
230 | clk_register_clkdev(clk[esdhc1_ipg], "ipg", "sdhci-esdhc-imx25.0"); | ||
231 | clk_register_clkdev(clk[esdhc1_ahb], "ahb", "sdhci-esdhc-imx25.0"); | ||
232 | clk_register_clkdev(clk[esdhc2_ipg_per], "per", "sdhci-esdhc-imx25.1"); | ||
233 | clk_register_clkdev(clk[esdhc2_ipg], "ipg", "sdhci-esdhc-imx25.1"); | ||
234 | clk_register_clkdev(clk[esdhc2_ahb], "ahb", "sdhci-esdhc-imx25.1"); | ||
235 | clk_register_clkdev(clk[csi_ipg_per], "per", "mx2-camera.0"); | ||
236 | clk_register_clkdev(clk[csi_ipg], "ipg", "mx2-camera.0"); | ||
237 | clk_register_clkdev(clk[csi_ahb], "ahb", "mx2-camera.0"); | ||
238 | clk_register_clkdev(clk[dummy], "audmux", NULL); | ||
239 | clk_register_clkdev(clk[can1_ipg], NULL, "flexcan.0"); | ||
240 | clk_register_clkdev(clk[can2_ipg], NULL, "flexcan.1"); | ||
241 | /* i.mx25 has the i.mx35 type sdma */ | ||
242 | clk_register_clkdev(clk[sdma_ipg], "ipg", "imx35-sdma"); | ||
243 | clk_register_clkdev(clk[sdma_ahb], "ahb", "imx35-sdma"); | ||
244 | clk_register_clkdev(clk[iim_ipg], "iim", NULL); | ||
245 | |||
246 | mxc_timer_init(NULL, MX25_IO_ADDRESS(MX25_GPT1_BASE_ADDR), 54); | ||
247 | return 0; | ||
248 | } | ||
diff --git a/arch/arm/mach-imx/clk-imx27.c b/arch/arm/mach-imx/clk-imx27.c new file mode 100644 index 000000000000..50a7ebd8d1b2 --- /dev/null +++ b/arch/arm/mach-imx/clk-imx27.c | |||
@@ -0,0 +1,290 @@ | |||
1 | #include <linux/clk.h> | ||
2 | #include <linux/io.h> | ||
3 | #include <linux/module.h> | ||
4 | #include <linux/clkdev.h> | ||
5 | #include <linux/err.h> | ||
6 | #include <linux/clk-provider.h> | ||
7 | #include <linux/of.h> | ||
8 | |||
9 | #include <mach/common.h> | ||
10 | #include <mach/hardware.h> | ||
11 | #include "clk.h" | ||
12 | |||
13 | #define IO_ADDR_CCM(off) (MX27_IO_ADDRESS(MX27_CCM_BASE_ADDR + (off))) | ||
14 | |||
15 | /* Register offsets */ | ||
16 | #define CCM_CSCR IO_ADDR_CCM(0x0) | ||
17 | #define CCM_MPCTL0 IO_ADDR_CCM(0x4) | ||
18 | #define CCM_MPCTL1 IO_ADDR_CCM(0x8) | ||
19 | #define CCM_SPCTL0 IO_ADDR_CCM(0xc) | ||
20 | #define CCM_SPCTL1 IO_ADDR_CCM(0x10) | ||
21 | #define CCM_OSC26MCTL IO_ADDR_CCM(0x14) | ||
22 | #define CCM_PCDR0 IO_ADDR_CCM(0x18) | ||
23 | #define CCM_PCDR1 IO_ADDR_CCM(0x1c) | ||
24 | #define CCM_PCCR0 IO_ADDR_CCM(0x20) | ||
25 | #define CCM_PCCR1 IO_ADDR_CCM(0x24) | ||
26 | #define CCM_CCSR IO_ADDR_CCM(0x28) | ||
27 | #define CCM_PMCTL IO_ADDR_CCM(0x2c) | ||
28 | #define CCM_PMCOUNT IO_ADDR_CCM(0x30) | ||
29 | #define CCM_WKGDCTL IO_ADDR_CCM(0x34) | ||
30 | |||
31 | #define CCM_CSCR_UPDATE_DIS (1 << 31) | ||
32 | #define CCM_CSCR_SSI2 (1 << 23) | ||
33 | #define CCM_CSCR_SSI1 (1 << 22) | ||
34 | #define CCM_CSCR_VPU (1 << 21) | ||
35 | #define CCM_CSCR_MSHC (1 << 20) | ||
36 | #define CCM_CSCR_SPLLRES (1 << 19) | ||
37 | #define CCM_CSCR_MPLLRES (1 << 18) | ||
38 | #define CCM_CSCR_SP (1 << 17) | ||
39 | #define CCM_CSCR_MCU (1 << 16) | ||
40 | #define CCM_CSCR_OSC26MDIV (1 << 4) | ||
41 | #define CCM_CSCR_OSC26M (1 << 3) | ||
42 | #define CCM_CSCR_FPM (1 << 2) | ||
43 | #define CCM_CSCR_SPEN (1 << 1) | ||
44 | #define CCM_CSCR_MPEN (1 << 0) | ||
45 | |||
46 | /* i.MX27 TO 2+ */ | ||
47 | #define CCM_CSCR_ARM_SRC (1 << 15) | ||
48 | |||
49 | #define CCM_SPCTL1_LF (1 << 15) | ||
50 | #define CCM_SPCTL1_BRMO (1 << 6) | ||
51 | |||
52 | static const char *vpu_sel_clks[] = { "spll", "mpll_main2", }; | ||
53 | static const char *cpu_sel_clks[] = { "mpll_main2", "mpll", }; | ||
54 | static const char *clko_sel_clks[] = { | ||
55 | "ckil", "prem", "ckih", "ckih", | ||
56 | "ckih", "mpll", "spll", "cpu_div", | ||
57 | "ahb", "ipg", "per1_div", "per2_div", | ||
58 | "per3_div", "per4_div", "ssi1_div", "ssi2_div", | ||
59 | "nfc_div", "mshc_div", "vpu_div", "60m", | ||
60 | "32k", "usb_div", "dptc", | ||
61 | }; | ||
62 | |||
63 | static const char *ssi_sel_clks[] = { "spll", "mpll", }; | ||
64 | |||
65 | enum mx27_clks { | ||
66 | dummy, ckih, ckil, mpll, spll, mpll_main2, ahb, ipg, nfc_div, per1_div, | ||
67 | per2_div, per3_div, per4_div, vpu_sel, vpu_div, usb_div, cpu_sel, | ||
68 | clko_sel, cpu_div, clko_div, ssi1_sel, ssi2_sel, ssi1_div, ssi2_div, | ||
69 | clko_en, ssi2_ipg_gate, ssi1_ipg_gate, slcdc_ipg_gate, sdhc3_ipg_gate, | ||
70 | sdhc2_ipg_gate, sdhc1_ipg_gate, scc_ipg_gate, sahara_ipg_gate, | ||
71 | rtc_ipg_gate, pwm_ipg_gate, owire_ipg_gate, lcdc_ipg_gate, | ||
72 | kpp_ipg_gate, iim_ipg_gate, i2c2_ipg_gate, i2c1_ipg_gate, | ||
73 | gpt6_ipg_gate, gpt5_ipg_gate, gpt4_ipg_gate, gpt3_ipg_gate, | ||
74 | gpt2_ipg_gate, gpt1_ipg_gate, gpio_ipg_gate, fec_ipg_gate, | ||
75 | emma_ipg_gate, dma_ipg_gate, cspi3_ipg_gate, cspi2_ipg_gate, | ||
76 | cspi1_ipg_gate, nfc_baud_gate, ssi2_baud_gate, ssi1_baud_gate, | ||
77 | vpu_baud_gate, per4_gate, per3_gate, per2_gate, per1_gate, | ||
78 | usb_ahb_gate, slcdc_ahb_gate, sahara_ahb_gate, lcdc_ahb_gate, | ||
79 | vpu_ahb_gate, fec_ahb_gate, emma_ahb_gate, emi_ahb_gate, dma_ahb_gate, | ||
80 | csi_ahb_gate, brom_ahb_gate, ata_ahb_gate, wdog_ipg_gate, usb_ipg_gate, | ||
81 | uart6_ipg_gate, uart5_ipg_gate, uart4_ipg_gate, uart3_ipg_gate, | ||
82 | uart2_ipg_gate, uart1_ipg_gate, clk_max | ||
83 | }; | ||
84 | |||
85 | static struct clk *clk[clk_max]; | ||
86 | |||
87 | int __init mx27_clocks_init(unsigned long fref) | ||
88 | { | ||
89 | int i; | ||
90 | |||
91 | clk[dummy] = imx_clk_fixed("dummy", 0); | ||
92 | clk[ckih] = imx_clk_fixed("ckih", fref); | ||
93 | clk[ckil] = imx_clk_fixed("ckil", 32768); | ||
94 | clk[mpll] = imx_clk_pllv1("mpll", "ckih", CCM_MPCTL0); | ||
95 | clk[spll] = imx_clk_pllv1("spll", "ckih", CCM_SPCTL0); | ||
96 | clk[mpll_main2] = imx_clk_fixed_factor("mpll_main2", "mpll", 2, 3); | ||
97 | |||
98 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0) { | ||
99 | clk[ahb] = imx_clk_divider("ahb", "mpll_main2", CCM_CSCR, 8, 2); | ||
100 | clk[ipg] = imx_clk_fixed_factor("ipg", "ahb", 1, 2); | ||
101 | } else { | ||
102 | clk[ahb] = imx_clk_divider("ahb", "mpll_main2", CCM_CSCR, 9, 4); | ||
103 | clk[ipg] = imx_clk_divider("ipg", "ahb", CCM_CSCR, 8, 1); | ||
104 | } | ||
105 | |||
106 | clk[nfc_div] = imx_clk_divider("nfc_div", "ahb", CCM_PCDR0, 6, 4); | ||
107 | clk[per1_div] = imx_clk_divider("per1_div", "mpll_main2", CCM_PCDR1, 0, 6); | ||
108 | clk[per2_div] = imx_clk_divider("per2_div", "mpll_main2", CCM_PCDR1, 8, 6); | ||
109 | clk[per3_div] = imx_clk_divider("per3_div", "mpll_main2", CCM_PCDR1, 16, 6); | ||
110 | clk[per4_div] = imx_clk_divider("per4_div", "mpll_main2", CCM_PCDR1, 24, 6); | ||
111 | clk[vpu_sel] = imx_clk_mux("vpu_sel", CCM_CSCR, 21, 1, vpu_sel_clks, ARRAY_SIZE(vpu_sel_clks)); | ||
112 | clk[vpu_div] = imx_clk_divider("vpu_div", "vpu_sel", CCM_PCDR0, 10, 3); | ||
113 | clk[usb_div] = imx_clk_divider("usb_div", "spll", CCM_CSCR, 28, 3); | ||
114 | clk[cpu_sel] = imx_clk_mux("cpu_sel", CCM_CSCR, 15, 1, cpu_sel_clks, ARRAY_SIZE(cpu_sel_clks)); | ||
115 | clk[clko_sel] = imx_clk_mux("clko_sel", CCM_CCSR, 0, 5, clko_sel_clks, ARRAY_SIZE(clko_sel_clks)); | ||
116 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0) | ||
117 | clk[cpu_div] = imx_clk_divider("cpu_div", "cpu_sel", CCM_CSCR, 12, 2); | ||
118 | else | ||
119 | clk[cpu_div] = imx_clk_divider("cpu_div", "cpu_sel", CCM_CSCR, 13, 3); | ||
120 | clk[clko_div] = imx_clk_divider("clko_div", "clko_sel", CCM_PCDR0, 22, 3); | ||
121 | clk[ssi1_sel] = imx_clk_mux("ssi1_sel", CCM_CSCR, 22, 1, ssi_sel_clks, ARRAY_SIZE(ssi_sel_clks)); | ||
122 | clk[ssi2_sel] = imx_clk_mux("ssi2_sel", CCM_CSCR, 23, 1, ssi_sel_clks, ARRAY_SIZE(ssi_sel_clks)); | ||
123 | clk[ssi1_div] = imx_clk_divider("ssi1_div", "ssi1_sel", CCM_PCDR0, 16, 6); | ||
124 | clk[ssi2_div] = imx_clk_divider("ssi2_div", "ssi2_sel", CCM_PCDR0, 26, 3); | ||
125 | clk[clko_en] = imx_clk_gate("clko_en", "clko_div", CCM_PCCR0, 0); | ||
126 | clk[ssi2_ipg_gate] = imx_clk_gate("ssi2_ipg_gate", "ipg", CCM_PCCR0, 0); | ||
127 | clk[ssi1_ipg_gate] = imx_clk_gate("ssi1_ipg_gate", "ipg", CCM_PCCR0, 1); | ||
128 | clk[slcdc_ipg_gate] = imx_clk_gate("slcdc_ipg_gate", "ipg", CCM_PCCR0, 2); | ||
129 | clk[sdhc3_ipg_gate] = imx_clk_gate("sdhc3_ipg_gate", "ipg", CCM_PCCR0, 3); | ||
130 | clk[sdhc2_ipg_gate] = imx_clk_gate("sdhc2_ipg_gate", "ipg", CCM_PCCR0, 4); | ||
131 | clk[sdhc1_ipg_gate] = imx_clk_gate("sdhc1_ipg_gate", "ipg", CCM_PCCR0, 5); | ||
132 | clk[scc_ipg_gate] = imx_clk_gate("scc_ipg_gate", "ipg", CCM_PCCR0, 6); | ||
133 | clk[sahara_ipg_gate] = imx_clk_gate("sahara_ipg_gate", "ipg", CCM_PCCR0, 7); | ||
134 | clk[rtc_ipg_gate] = imx_clk_gate("rtc_ipg_gate", "ipg", CCM_PCCR0, 9); | ||
135 | clk[pwm_ipg_gate] = imx_clk_gate("pwm_ipg_gate", "ipg", CCM_PCCR0, 11); | ||
136 | clk[owire_ipg_gate] = imx_clk_gate("owire_ipg_gate", "ipg", CCM_PCCR0, 12); | ||
137 | clk[lcdc_ipg_gate] = imx_clk_gate("lcdc_ipg_gate", "ipg", CCM_PCCR0, 14); | ||
138 | clk[kpp_ipg_gate] = imx_clk_gate("kpp_ipg_gate", "ipg", CCM_PCCR0, 15); | ||
139 | clk[iim_ipg_gate] = imx_clk_gate("iim_ipg_gate", "ipg", CCM_PCCR0, 16); | ||
140 | clk[i2c2_ipg_gate] = imx_clk_gate("i2c2_ipg_gate", "ipg", CCM_PCCR0, 17); | ||
141 | clk[i2c1_ipg_gate] = imx_clk_gate("i2c1_ipg_gate", "ipg", CCM_PCCR0, 18); | ||
142 | clk[gpt6_ipg_gate] = imx_clk_gate("gpt6_ipg_gate", "ipg", CCM_PCCR0, 19); | ||
143 | clk[gpt5_ipg_gate] = imx_clk_gate("gpt5_ipg_gate", "ipg", CCM_PCCR0, 20); | ||
144 | clk[gpt4_ipg_gate] = imx_clk_gate("gpt4_ipg_gate", "ipg", CCM_PCCR0, 21); | ||
145 | clk[gpt3_ipg_gate] = imx_clk_gate("gpt3_ipg_gate", "ipg", CCM_PCCR0, 22); | ||
146 | clk[gpt2_ipg_gate] = imx_clk_gate("gpt2_ipg_gate", "ipg", CCM_PCCR0, 23); | ||
147 | clk[gpt1_ipg_gate] = imx_clk_gate("gpt1_ipg_gate", "ipg", CCM_PCCR0, 24); | ||
148 | clk[gpio_ipg_gate] = imx_clk_gate("gpio_ipg_gate", "ipg", CCM_PCCR0, 25); | ||
149 | clk[fec_ipg_gate] = imx_clk_gate("fec_ipg_gate", "ipg", CCM_PCCR0, 26); | ||
150 | clk[emma_ipg_gate] = imx_clk_gate("emma_ipg_gate", "ipg", CCM_PCCR0, 27); | ||
151 | clk[dma_ipg_gate] = imx_clk_gate("dma_ipg_gate", "ipg", CCM_PCCR0, 28); | ||
152 | clk[cspi3_ipg_gate] = imx_clk_gate("cspi3_ipg_gate", "ipg", CCM_PCCR0, 29); | ||
153 | clk[cspi2_ipg_gate] = imx_clk_gate("cspi2_ipg_gate", "ipg", CCM_PCCR0, 30); | ||
154 | clk[cspi1_ipg_gate] = imx_clk_gate("cspi1_ipg_gate", "ipg", CCM_PCCR0, 31); | ||
155 | clk[nfc_baud_gate] = imx_clk_gate("nfc_baud_gate", "nfc_div", CCM_PCCR1, 3); | ||
156 | clk[ssi2_baud_gate] = imx_clk_gate("ssi2_baud_gate", "ssi2_div", CCM_PCCR1, 4); | ||
157 | clk[ssi1_baud_gate] = imx_clk_gate("ssi1_baud_gate", "ssi1_div", CCM_PCCR1, 5); | ||
158 | clk[vpu_baud_gate] = imx_clk_gate("vpu_baud_gate", "vpu_div", CCM_PCCR1, 6); | ||
159 | clk[per4_gate] = imx_clk_gate("per4_gate", "per4_div", CCM_PCCR1, 7); | ||
160 | clk[per3_gate] = imx_clk_gate("per3_gate", "per3_div", CCM_PCCR1, 8); | ||
161 | clk[per2_gate] = imx_clk_gate("per2_gate", "per2_div", CCM_PCCR1, 9); | ||
162 | clk[per1_gate] = imx_clk_gate("per1_gate", "per1_div", CCM_PCCR1, 10); | ||
163 | clk[usb_ahb_gate] = imx_clk_gate("usb_ahb_gate", "ahb", CCM_PCCR1, 11); | ||
164 | clk[slcdc_ahb_gate] = imx_clk_gate("slcdc_ahb_gate", "ahb", CCM_PCCR1, 12); | ||
165 | clk[sahara_ahb_gate] = imx_clk_gate("sahara_ahb_gate", "ahb", CCM_PCCR1, 13); | ||
166 | clk[lcdc_ahb_gate] = imx_clk_gate("lcdc_ahb_gate", "ahb", CCM_PCCR1, 15); | ||
167 | clk[vpu_ahb_gate] = imx_clk_gate("vpu_ahb_gate", "ahb", CCM_PCCR1, 16); | ||
168 | clk[fec_ahb_gate] = imx_clk_gate("fec_ahb_gate", "ahb", CCM_PCCR1, 17); | ||
169 | clk[emma_ahb_gate] = imx_clk_gate("emma_ahb_gate", "ahb", CCM_PCCR1, 18); | ||
170 | clk[emi_ahb_gate] = imx_clk_gate("emi_ahb_gate", "ahb", CCM_PCCR1, 19); | ||
171 | clk[dma_ahb_gate] = imx_clk_gate("dma_ahb_gate", "ahb", CCM_PCCR1, 20); | ||
172 | clk[csi_ahb_gate] = imx_clk_gate("csi_ahb_gate", "ahb", CCM_PCCR1, 21); | ||
173 | clk[brom_ahb_gate] = imx_clk_gate("brom_ahb_gate", "ahb", CCM_PCCR1, 22); | ||
174 | clk[ata_ahb_gate] = imx_clk_gate("ata_ahb_gate", "ahb", CCM_PCCR1, 23); | ||
175 | clk[wdog_ipg_gate] = imx_clk_gate("wdog_ipg_gate", "ipg", CCM_PCCR1, 24); | ||
176 | clk[usb_ipg_gate] = imx_clk_gate("usb_ipg_gate", "ipg", CCM_PCCR1, 25); | ||
177 | clk[uart6_ipg_gate] = imx_clk_gate("uart6_ipg_gate", "ipg", CCM_PCCR1, 26); | ||
178 | clk[uart5_ipg_gate] = imx_clk_gate("uart5_ipg_gate", "ipg", CCM_PCCR1, 27); | ||
179 | clk[uart4_ipg_gate] = imx_clk_gate("uart4_ipg_gate", "ipg", CCM_PCCR1, 28); | ||
180 | clk[uart3_ipg_gate] = imx_clk_gate("uart3_ipg_gate", "ipg", CCM_PCCR1, 29); | ||
181 | clk[uart2_ipg_gate] = imx_clk_gate("uart2_ipg_gate", "ipg", CCM_PCCR1, 30); | ||
182 | clk[uart1_ipg_gate] = imx_clk_gate("uart1_ipg_gate", "ipg", CCM_PCCR1, 31); | ||
183 | |||
184 | for (i = 0; i < ARRAY_SIZE(clk); i++) | ||
185 | if (IS_ERR(clk[i])) | ||
186 | pr_err("i.MX27 clk %d: register failed with %ld\n", | ||
187 | i, PTR_ERR(clk[i])); | ||
188 | |||
189 | clk_register_clkdev(clk[uart1_ipg_gate], "ipg", "imx21-uart.0"); | ||
190 | clk_register_clkdev(clk[per1_gate], "per", "imx21-uart.0"); | ||
191 | clk_register_clkdev(clk[uart2_ipg_gate], "ipg", "imx21-uart.1"); | ||
192 | clk_register_clkdev(clk[per1_gate], "per", "imx21-uart.1"); | ||
193 | clk_register_clkdev(clk[uart3_ipg_gate], "ipg", "imx21-uart.2"); | ||
194 | clk_register_clkdev(clk[per1_gate], "per", "imx21-uart.2"); | ||
195 | clk_register_clkdev(clk[uart4_ipg_gate], "ipg", "imx21-uart.3"); | ||
196 | clk_register_clkdev(clk[per1_gate], "per", "imx21-uart.3"); | ||
197 | clk_register_clkdev(clk[uart5_ipg_gate], "ipg", "imx21-uart.4"); | ||
198 | clk_register_clkdev(clk[per1_gate], "per", "imx21-uart.4"); | ||
199 | clk_register_clkdev(clk[uart6_ipg_gate], "ipg", "imx21-uart.5"); | ||
200 | clk_register_clkdev(clk[per1_gate], "per", "imx21-uart.5"); | ||
201 | clk_register_clkdev(clk[gpt1_ipg_gate], "ipg", "imx-gpt.0"); | ||
202 | clk_register_clkdev(clk[per1_gate], "per", "imx-gpt.0"); | ||
203 | clk_register_clkdev(clk[gpt2_ipg_gate], "ipg", "imx-gpt.1"); | ||
204 | clk_register_clkdev(clk[per1_gate], "per", "imx-gpt.1"); | ||
205 | clk_register_clkdev(clk[gpt3_ipg_gate], "ipg", "imx-gpt.2"); | ||
206 | clk_register_clkdev(clk[per1_gate], "per", "imx-gpt.2"); | ||
207 | clk_register_clkdev(clk[gpt4_ipg_gate], "ipg", "imx-gpt.3"); | ||
208 | clk_register_clkdev(clk[per1_gate], "per", "imx-gpt.3"); | ||
209 | clk_register_clkdev(clk[gpt5_ipg_gate], "ipg", "imx-gpt.4"); | ||
210 | clk_register_clkdev(clk[per1_gate], "per", "imx-gpt.4"); | ||
211 | clk_register_clkdev(clk[gpt6_ipg_gate], "ipg", "imx-gpt.5"); | ||
212 | clk_register_clkdev(clk[per1_gate], "per", "imx-gpt.5"); | ||
213 | clk_register_clkdev(clk[pwm_ipg_gate], NULL, "mxc_pwm.0"); | ||
214 | clk_register_clkdev(clk[per2_gate], "per", "mxc-mmc.0"); | ||
215 | clk_register_clkdev(clk[sdhc1_ipg_gate], "ipg", "mxc-mmc.0"); | ||
216 | clk_register_clkdev(clk[per2_gate], "per", "mxc-mmc.1"); | ||
217 | clk_register_clkdev(clk[sdhc2_ipg_gate], "ipg", "mxc-mmc.1"); | ||
218 | clk_register_clkdev(clk[per2_gate], "per", "mxc-mmc.2"); | ||
219 | clk_register_clkdev(clk[sdhc2_ipg_gate], "ipg", "mxc-mmc.2"); | ||
220 | clk_register_clkdev(clk[cspi1_ipg_gate], NULL, "imx27-cspi.0"); | ||
221 | clk_register_clkdev(clk[cspi2_ipg_gate], NULL, "imx27-cspi.1"); | ||
222 | clk_register_clkdev(clk[cspi3_ipg_gate], NULL, "imx27-cspi.2"); | ||
223 | clk_register_clkdev(clk[per3_gate], "per", "imx-fb.0"); | ||
224 | clk_register_clkdev(clk[lcdc_ipg_gate], "ipg", "imx-fb.0"); | ||
225 | clk_register_clkdev(clk[lcdc_ahb_gate], "ahb", "imx-fb.0"); | ||
226 | clk_register_clkdev(clk[csi_ahb_gate], NULL, "mx2-camera.0"); | ||
227 | clk_register_clkdev(clk[usb_div], "per", "fsl-usb2-udc"); | ||
228 | clk_register_clkdev(clk[usb_ipg_gate], "ipg", "fsl-usb2-udc"); | ||
229 | clk_register_clkdev(clk[usb_ahb_gate], "ahb", "fsl-usb2-udc"); | ||
230 | clk_register_clkdev(clk[usb_div], "per", "mxc-ehci.0"); | ||
231 | clk_register_clkdev(clk[usb_ipg_gate], "ipg", "mxc-ehci.0"); | ||
232 | clk_register_clkdev(clk[usb_ahb_gate], "ahb", "mxc-ehci.0"); | ||
233 | clk_register_clkdev(clk[usb_div], "per", "mxc-ehci.1"); | ||
234 | clk_register_clkdev(clk[usb_ipg_gate], "ipg", "mxc-ehci.1"); | ||
235 | clk_register_clkdev(clk[usb_ahb_gate], "ahb", "mxc-ehci.1"); | ||
236 | clk_register_clkdev(clk[usb_div], "per", "mxc-ehci.2"); | ||
237 | clk_register_clkdev(clk[usb_ipg_gate], "ipg", "mxc-ehci.2"); | ||
238 | clk_register_clkdev(clk[usb_ahb_gate], "ahb", "mxc-ehci.2"); | ||
239 | clk_register_clkdev(clk[ssi1_ipg_gate], NULL, "imx-ssi.0"); | ||
240 | clk_register_clkdev(clk[ssi2_ipg_gate], NULL, "imx-ssi.1"); | ||
241 | clk_register_clkdev(clk[nfc_baud_gate], NULL, "mxc_nand.0"); | ||
242 | clk_register_clkdev(clk[vpu_baud_gate], "per", "imx-vpu"); | ||
243 | clk_register_clkdev(clk[vpu_ahb_gate], "ahb", "imx-vpu"); | ||
244 | clk_register_clkdev(clk[dma_ahb_gate], "ahb", "imx-dma"); | ||
245 | clk_register_clkdev(clk[dma_ipg_gate], "ipg", "imx-dma"); | ||
246 | clk_register_clkdev(clk[fec_ipg_gate], "ipg", "imx27-fec.0"); | ||
247 | clk_register_clkdev(clk[fec_ahb_gate], "ahb", "imx27-fec.0"); | ||
248 | clk_register_clkdev(clk[wdog_ipg_gate], NULL, "imx2-wdt.0"); | ||
249 | clk_register_clkdev(clk[i2c1_ipg_gate], NULL, "imx-i2c.0"); | ||
250 | clk_register_clkdev(clk[i2c2_ipg_gate], NULL, "imx-i2c.1"); | ||
251 | clk_register_clkdev(clk[owire_ipg_gate], NULL, "mxc_w1.0"); | ||
252 | clk_register_clkdev(clk[kpp_ipg_gate], NULL, "imx-keypad"); | ||
253 | clk_register_clkdev(clk[emma_ahb_gate], "ahb", "imx-emma"); | ||
254 | clk_register_clkdev(clk[emma_ipg_gate], "ipg", "imx-emma"); | ||
255 | clk_register_clkdev(clk[iim_ipg_gate], "iim", NULL); | ||
256 | clk_register_clkdev(clk[gpio_ipg_gate], "gpio", NULL); | ||
257 | clk_register_clkdev(clk[brom_ahb_gate], "brom", NULL); | ||
258 | clk_register_clkdev(clk[ata_ahb_gate], "ata", NULL); | ||
259 | clk_register_clkdev(clk[rtc_ipg_gate], "rtc", NULL); | ||
260 | clk_register_clkdev(clk[scc_ipg_gate], "scc", NULL); | ||
261 | clk_register_clkdev(clk[cpu_div], "cpu", NULL); | ||
262 | clk_register_clkdev(clk[emi_ahb_gate], "emi_ahb" , NULL); | ||
263 | clk_register_clkdev(clk[ssi1_baud_gate], "bitrate" , "imx-ssi.0"); | ||
264 | clk_register_clkdev(clk[ssi2_baud_gate], "bitrate" , "imx-ssi.1"); | ||
265 | |||
266 | mxc_timer_init(NULL, MX27_IO_ADDRESS(MX27_GPT1_BASE_ADDR), | ||
267 | MX27_INT_GPT1); | ||
268 | |||
269 | clk_prepare_enable(clk[emi_ahb_gate]); | ||
270 | |||
271 | return 0; | ||
272 | } | ||
273 | |||
274 | #ifdef CONFIG_OF | ||
275 | int __init mx27_clocks_init_dt(void) | ||
276 | { | ||
277 | struct device_node *np; | ||
278 | u32 fref = 26000000; /* default */ | ||
279 | |||
280 | for_each_compatible_node(np, NULL, "fixed-clock") { | ||
281 | if (!of_device_is_compatible(np, "fsl,imx-osc26m")) | ||
282 | continue; | ||
283 | |||
284 | if (!of_property_read_u32(np, "clock-frequency", &fref)) | ||
285 | break; | ||
286 | } | ||
287 | |||
288 | return mx27_clocks_init(fref); | ||
289 | } | ||
290 | #endif | ||
diff --git a/arch/arm/mach-imx/clk-imx31.c b/arch/arm/mach-imx/clk-imx31.c new file mode 100644 index 000000000000..a854b9cae5ea --- /dev/null +++ b/arch/arm/mach-imx/clk-imx31.c | |||
@@ -0,0 +1,182 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2012 Sascha Hauer <kernel@pengutronix.de> | ||
3 | * | ||
4 | * This program is free software; you can redistribute it and/or | ||
5 | * modify it under the terms of the GNU General Public License | ||
6 | * as published by the Free Software Foundation; either version 2 | ||
7 | * of the License, or (at your option) any later version. | ||
8 | * This program is distributed in the hope that it will be useful, | ||
9 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
10 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
11 | * GNU General Public License for more details. | ||
12 | * | ||
13 | * You should have received a copy of the GNU General Public License | ||
14 | * along with this program; if not, write to the Free Software | ||
15 | * Foundation. | ||
16 | */ | ||
17 | |||
18 | #include <linux/module.h> | ||
19 | #include <linux/clk.h> | ||
20 | #include <linux/clkdev.h> | ||
21 | #include <linux/io.h> | ||
22 | #include <linux/err.h> | ||
23 | |||
24 | #include <mach/hardware.h> | ||
25 | #include <mach/mx31.h> | ||
26 | #include <mach/common.h> | ||
27 | |||
28 | #include "clk.h" | ||
29 | #include "crmregs-imx3.h" | ||
30 | |||
31 | static const char *mcu_main_sel[] = { "spll", "mpll", }; | ||
32 | static const char *per_sel[] = { "per_div", "ipg", }; | ||
33 | static const char *csi_sel[] = { "upll", "spll", }; | ||
34 | static const char *fir_sel[] = { "mcu_main", "upll", "spll" }; | ||
35 | |||
36 | enum mx31_clks { | ||
37 | ckih, ckil, mpll, spll, upll, mcu_main, hsp, ahb, nfc, ipg, per_div, | ||
38 | per, csi, fir, csi_div, usb_div_pre, usb_div_post, fir_div_pre, | ||
39 | fir_div_post, sdhc1_gate, sdhc2_gate, gpt_gate, epit1_gate, epit2_gate, | ||
40 | iim_gate, ata_gate, sdma_gate, cspi3_gate, rng_gate, uart1_gate, | ||
41 | uart2_gate, ssi1_gate, i2c1_gate, i2c2_gate, i2c3_gate, hantro_gate, | ||
42 | mstick1_gate, mstick2_gate, csi_gate, rtc_gate, wdog_gate, pwm_gate, | ||
43 | sim_gate, ect_gate, usb_gate, kpp_gate, ipu_gate, uart3_gate, | ||
44 | uart4_gate, uart5_gate, owire_gate, ssi2_gate, cspi1_gate, cspi2_gate, | ||
45 | gacc_gate, emi_gate, rtic_gate, firi_gate, clk_max | ||
46 | }; | ||
47 | |||
48 | static struct clk *clk[clk_max]; | ||
49 | |||
50 | int __init mx31_clocks_init(unsigned long fref) | ||
51 | { | ||
52 | void __iomem *base = MX31_IO_ADDRESS(MX31_CCM_BASE_ADDR); | ||
53 | int i; | ||
54 | |||
55 | clk[ckih] = imx_clk_fixed("ckih", fref); | ||
56 | clk[ckil] = imx_clk_fixed("ckil", 32768); | ||
57 | clk[mpll] = imx_clk_pllv1("mpll", "ckih", base + MXC_CCM_MPCTL); | ||
58 | clk[spll] = imx_clk_pllv1("spll", "ckih", base + MXC_CCM_SRPCTL); | ||
59 | clk[upll] = imx_clk_pllv1("upll", "ckih", base + MXC_CCM_UPCTL); | ||
60 | clk[mcu_main] = imx_clk_mux("mcu_main", base + MXC_CCM_PMCR0, 31, 1, mcu_main_sel, ARRAY_SIZE(mcu_main_sel)); | ||
61 | clk[hsp] = imx_clk_divider("hsp", "mcu_main", base + MXC_CCM_PDR0, 11, 3); | ||
62 | clk[ahb] = imx_clk_divider("ahb", "mcu_main", base + MXC_CCM_PDR0, 3, 3); | ||
63 | clk[nfc] = imx_clk_divider("nfc", "ahb", base + MXC_CCM_PDR0, 8, 3); | ||
64 | clk[ipg] = imx_clk_divider("ipg", "ahb", base + MXC_CCM_PDR0, 6, 2); | ||
65 | clk[per_div] = imx_clk_divider("per_div", "upll", base + MXC_CCM_PDR0, 16, 5); | ||
66 | clk[per] = imx_clk_mux("per", base + MXC_CCM_CCMR, 24, 1, per_sel, ARRAY_SIZE(per_sel)); | ||
67 | clk[csi] = imx_clk_mux("csi_sel", base + MXC_CCM_CCMR, 25, 1, csi_sel, ARRAY_SIZE(csi_sel)); | ||
68 | clk[fir] = imx_clk_mux("fir_sel", base + MXC_CCM_CCMR, 11, 2, fir_sel, ARRAY_SIZE(fir_sel)); | ||
69 | clk[csi_div] = imx_clk_divider("csi_div", "csi_sel", base + MXC_CCM_PDR0, 23, 9); | ||
70 | clk[usb_div_pre] = imx_clk_divider("usb_div_pre", "upll", base + MXC_CCM_PDR1, 30, 2); | ||
71 | clk[usb_div_post] = imx_clk_divider("usb_div_post", "usb_div_pre", base + MXC_CCM_PDR1, 27, 3); | ||
72 | clk[fir_div_pre] = imx_clk_divider("fir_div_pre", "fir_sel", base + MXC_CCM_PDR1, 24, 3); | ||
73 | clk[fir_div_post] = imx_clk_divider("fir_div_post", "fir_div_pre", base + MXC_CCM_PDR1, 23, 6); | ||
74 | clk[sdhc1_gate] = imx_clk_gate2("sdhc1_gate", "per", base + MXC_CCM_CGR0, 0); | ||
75 | clk[sdhc2_gate] = imx_clk_gate2("sdhc2_gate", "per", base + MXC_CCM_CGR0, 2); | ||
76 | clk[gpt_gate] = imx_clk_gate2("gpt_gate", "per", base + MXC_CCM_CGR0, 4); | ||
77 | clk[epit1_gate] = imx_clk_gate2("epit1_gate", "per", base + MXC_CCM_CGR0, 6); | ||
78 | clk[epit2_gate] = imx_clk_gate2("epit2_gate", "per", base + MXC_CCM_CGR0, 8); | ||
79 | clk[iim_gate] = imx_clk_gate2("iim_gate", "ipg", base + MXC_CCM_CGR0, 10); | ||
80 | clk[ata_gate] = imx_clk_gate2("ata_gate", "ipg", base + MXC_CCM_CGR0, 12); | ||
81 | clk[sdma_gate] = imx_clk_gate2("sdma_gate", "ahb", base + MXC_CCM_CGR0, 14); | ||
82 | clk[cspi3_gate] = imx_clk_gate2("cspi3_gate", "ipg", base + MXC_CCM_CGR0, 16); | ||
83 | clk[rng_gate] = imx_clk_gate2("rng_gate", "ipg", base + MXC_CCM_CGR0, 18); | ||
84 | clk[uart1_gate] = imx_clk_gate2("uart1_gate", "per", base + MXC_CCM_CGR0, 20); | ||
85 | clk[uart2_gate] = imx_clk_gate2("uart2_gate", "per", base + MXC_CCM_CGR0, 22); | ||
86 | clk[ssi1_gate] = imx_clk_gate2("ssi1_gate", "spll", base + MXC_CCM_CGR0, 24); | ||
87 | clk[i2c1_gate] = imx_clk_gate2("i2c1_gate", "per", base + MXC_CCM_CGR0, 26); | ||
88 | clk[i2c2_gate] = imx_clk_gate2("i2c2_gate", "per", base + MXC_CCM_CGR0, 28); | ||
89 | clk[i2c3_gate] = imx_clk_gate2("i2c3_gate", "per", base + MXC_CCM_CGR0, 30); | ||
90 | clk[hantro_gate] = imx_clk_gate2("hantro_gate", "per", base + MXC_CCM_CGR1, 0); | ||
91 | clk[mstick1_gate] = imx_clk_gate2("mstick1_gate", "per", base + MXC_CCM_CGR1, 2); | ||
92 | clk[mstick2_gate] = imx_clk_gate2("mstick2_gate", "per", base + MXC_CCM_CGR1, 4); | ||
93 | clk[csi_gate] = imx_clk_gate2("csi_gate", "csi_div", base + MXC_CCM_CGR1, 6); | ||
94 | clk[rtc_gate] = imx_clk_gate2("rtc_gate", "ipg", base + MXC_CCM_CGR1, 8); | ||
95 | clk[wdog_gate] = imx_clk_gate2("wdog_gate", "ipg", base + MXC_CCM_CGR1, 10); | ||
96 | clk[pwm_gate] = imx_clk_gate2("pwm_gate", "per", base + MXC_CCM_CGR1, 12); | ||
97 | clk[sim_gate] = imx_clk_gate2("sim_gate", "per", base + MXC_CCM_CGR1, 14); | ||
98 | clk[ect_gate] = imx_clk_gate2("ect_gate", "per", base + MXC_CCM_CGR1, 16); | ||
99 | clk[usb_gate] = imx_clk_gate2("usb_gate", "ahb", base + MXC_CCM_CGR1, 18); | ||
100 | clk[kpp_gate] = imx_clk_gate2("kpp_gate", "ipg", base + MXC_CCM_CGR1, 20); | ||
101 | clk[ipu_gate] = imx_clk_gate2("ipu_gate", "hsp", base + MXC_CCM_CGR1, 22); | ||
102 | clk[uart3_gate] = imx_clk_gate2("uart3_gate", "per", base + MXC_CCM_CGR1, 24); | ||
103 | clk[uart4_gate] = imx_clk_gate2("uart4_gate", "per", base + MXC_CCM_CGR1, 26); | ||
104 | clk[uart5_gate] = imx_clk_gate2("uart5_gate", "per", base + MXC_CCM_CGR1, 28); | ||
105 | clk[owire_gate] = imx_clk_gate2("owire_gate", "per", base + MXC_CCM_CGR1, 30); | ||
106 | clk[ssi2_gate] = imx_clk_gate2("ssi2_gate", "spll", base + MXC_CCM_CGR2, 0); | ||
107 | clk[cspi1_gate] = imx_clk_gate2("cspi1_gate", "ipg", base + MXC_CCM_CGR2, 2); | ||
108 | clk[cspi2_gate] = imx_clk_gate2("cspi2_gate", "ipg", base + MXC_CCM_CGR2, 4); | ||
109 | clk[gacc_gate] = imx_clk_gate2("gacc_gate", "per", base + MXC_CCM_CGR2, 6); | ||
110 | clk[emi_gate] = imx_clk_gate2("emi_gate", "ahb", base + MXC_CCM_CGR2, 8); | ||
111 | clk[rtic_gate] = imx_clk_gate2("rtic_gate", "ahb", base + MXC_CCM_CGR2, 10); | ||
112 | clk[firi_gate] = imx_clk_gate2("firi_gate", "upll", base+MXC_CCM_CGR2, 12); | ||
113 | |||
114 | for (i = 0; i < ARRAY_SIZE(clk); i++) | ||
115 | if (IS_ERR(clk[i])) | ||
116 | pr_err("imx31 clk %d: register failed with %ld\n", | ||
117 | i, PTR_ERR(clk[i])); | ||
118 | |||
119 | clk_register_clkdev(clk[gpt_gate], "per", "imx-gpt.0"); | ||
120 | clk_register_clkdev(clk[ipg], "ipg", "imx-gpt.0"); | ||
121 | clk_register_clkdev(clk[cspi1_gate], NULL, "imx31-cspi.0"); | ||
122 | clk_register_clkdev(clk[cspi2_gate], NULL, "imx31-cspi.1"); | ||
123 | clk_register_clkdev(clk[cspi3_gate], NULL, "imx31-cspi.2"); | ||
124 | clk_register_clkdev(clk[pwm_gate], "pwm", NULL); | ||
125 | clk_register_clkdev(clk[wdog_gate], NULL, "imx2-wdt.0"); | ||
126 | clk_register_clkdev(clk[rtc_gate], "rtc", NULL); | ||
127 | clk_register_clkdev(clk[epit1_gate], "epit", NULL); | ||
128 | clk_register_clkdev(clk[epit2_gate], "epit", NULL); | ||
129 | clk_register_clkdev(clk[nfc], NULL, "mxc_nand.0"); | ||
130 | clk_register_clkdev(clk[ipu_gate], NULL, "ipu-core"); | ||
131 | clk_register_clkdev(clk[ipu_gate], NULL, "mx3_sdc_fb"); | ||
132 | clk_register_clkdev(clk[kpp_gate], "kpp", NULL); | ||
133 | clk_register_clkdev(clk[usb_div_post], "per", "mxc-ehci.0"); | ||
134 | clk_register_clkdev(clk[usb_gate], "ahb", "mxc-ehci.0"); | ||
135 | clk_register_clkdev(clk[ipg], "ipg", "mxc-ehci.0"); | ||
136 | clk_register_clkdev(clk[usb_div_post], "per", "mxc-ehci.1"); | ||
137 | clk_register_clkdev(clk[usb_gate], "ahb", "mxc-ehci.1"); | ||
138 | clk_register_clkdev(clk[ipg], "ipg", "mxc-ehci.1"); | ||
139 | clk_register_clkdev(clk[usb_div_post], "per", "mxc-ehci.2"); | ||
140 | clk_register_clkdev(clk[usb_gate], "ahb", "mxc-ehci.2"); | ||
141 | clk_register_clkdev(clk[ipg], "ipg", "mxc-ehci.2"); | ||
142 | clk_register_clkdev(clk[usb_div_post], "per", "fsl-usb2-udc"); | ||
143 | clk_register_clkdev(clk[usb_gate], "ahb", "fsl-usb2-udc"); | ||
144 | clk_register_clkdev(clk[ipg], "ipg", "fsl-usb2-udc"); | ||
145 | clk_register_clkdev(clk[csi_gate], NULL, "mx3-camera.0"); | ||
146 | /* i.mx31 has the i.mx21 type uart */ | ||
147 | clk_register_clkdev(clk[uart1_gate], "per", "imx21-uart.0"); | ||
148 | clk_register_clkdev(clk[ipg], "ipg", "imx21-uart.0"); | ||
149 | clk_register_clkdev(clk[uart2_gate], "per", "imx21-uart.1"); | ||
150 | clk_register_clkdev(clk[ipg], "ipg", "imx21-uart.1"); | ||
151 | clk_register_clkdev(clk[uart3_gate], "per", "imx21-uart.2"); | ||
152 | clk_register_clkdev(clk[ipg], "ipg", "imx21-uart.2"); | ||
153 | clk_register_clkdev(clk[uart4_gate], "per", "imx21-uart.3"); | ||
154 | clk_register_clkdev(clk[ipg], "ipg", "imx21-uart.3"); | ||
155 | clk_register_clkdev(clk[uart5_gate], "per", "imx21-uart.4"); | ||
156 | clk_register_clkdev(clk[ipg], "ipg", "imx21-uart.4"); | ||
157 | clk_register_clkdev(clk[i2c1_gate], NULL, "imx-i2c.0"); | ||
158 | clk_register_clkdev(clk[i2c2_gate], NULL, "imx-i2c.1"); | ||
159 | clk_register_clkdev(clk[i2c3_gate], NULL, "imx-i2c.2"); | ||
160 | clk_register_clkdev(clk[owire_gate], NULL, "mxc_w1.0"); | ||
161 | clk_register_clkdev(clk[sdhc1_gate], NULL, "mxc-mmc.0"); | ||
162 | clk_register_clkdev(clk[sdhc2_gate], NULL, "mxc-mmc.1"); | ||
163 | clk_register_clkdev(clk[ssi1_gate], NULL, "imx-ssi.0"); | ||
164 | clk_register_clkdev(clk[ssi2_gate], NULL, "imx-ssi.1"); | ||
165 | clk_register_clkdev(clk[firi_gate], "firi", NULL); | ||
166 | clk_register_clkdev(clk[ata_gate], NULL, "pata_imx"); | ||
167 | clk_register_clkdev(clk[rtic_gate], "rtic", NULL); | ||
168 | clk_register_clkdev(clk[rng_gate], "rng", NULL); | ||
169 | clk_register_clkdev(clk[sdma_gate], NULL, "imx31-sdma"); | ||
170 | clk_register_clkdev(clk[iim_gate], "iim", NULL); | ||
171 | |||
172 | clk_set_parent(clk[csi], clk[upll]); | ||
173 | clk_prepare_enable(clk[emi_gate]); | ||
174 | clk_prepare_enable(clk[iim_gate]); | ||
175 | mx31_revision(); | ||
176 | clk_disable_unprepare(clk[iim_gate]); | ||
177 | |||
178 | mxc_timer_init(NULL, MX31_IO_ADDRESS(MX31_GPT1_BASE_ADDR), | ||
179 | MX31_INT_GPT); | ||
180 | |||
181 | return 0; | ||
182 | } | ||
diff --git a/arch/arm/mach-imx/clk-imx35.c b/arch/arm/mach-imx/clk-imx35.c new file mode 100644 index 000000000000..a9e60bf7dd75 --- /dev/null +++ b/arch/arm/mach-imx/clk-imx35.c | |||
@@ -0,0 +1,278 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2012 Sascha Hauer, Pengutronix <s.hauer@pengutronix.de> | ||
3 | * | ||
4 | * This program is free software; you can redistribute it and/or modify | ||
5 | * it under the terms of the GNU General Public License version 2 as | ||
6 | * published by the Free Software Foundation. | ||
7 | * | ||
8 | */ | ||
9 | #include <linux/mm.h> | ||
10 | #include <linux/delay.h> | ||
11 | #include <linux/clk.h> | ||
12 | #include <linux/io.h> | ||
13 | #include <linux/clkdev.h> | ||
14 | #include <linux/of.h> | ||
15 | #include <linux/err.h> | ||
16 | |||
17 | #include <mach/hardware.h> | ||
18 | #include <mach/common.h> | ||
19 | |||
20 | #include "crmregs-imx3.h" | ||
21 | #include "clk.h" | ||
22 | |||
23 | struct arm_ahb_div { | ||
24 | unsigned char arm, ahb, sel; | ||
25 | }; | ||
26 | |||
27 | static struct arm_ahb_div clk_consumer[] = { | ||
28 | { .arm = 1, .ahb = 4, .sel = 0}, | ||
29 | { .arm = 1, .ahb = 3, .sel = 1}, | ||
30 | { .arm = 2, .ahb = 2, .sel = 0}, | ||
31 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
32 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
33 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
34 | { .arm = 4, .ahb = 1, .sel = 0}, | ||
35 | { .arm = 1, .ahb = 5, .sel = 0}, | ||
36 | { .arm = 1, .ahb = 8, .sel = 0}, | ||
37 | { .arm = 1, .ahb = 6, .sel = 1}, | ||
38 | { .arm = 2, .ahb = 4, .sel = 0}, | ||
39 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
40 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
41 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
42 | { .arm = 4, .ahb = 2, .sel = 0}, | ||
43 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
44 | }; | ||
45 | |||
46 | static char hsp_div_532[] = { 4, 8, 3, 0 }; | ||
47 | static char hsp_div_400[] = { 3, 6, 3, 0 }; | ||
48 | |||
49 | static const char *std_sel[] = {"ppll", "arm"}; | ||
50 | static const char *ipg_per_sel[] = {"ahb_per_div", "arm_per_div"}; | ||
51 | |||
52 | enum mx35_clks { | ||
53 | ckih, mpll, ppll, mpll_075, arm, hsp, hsp_div, hsp_sel, ahb, ipg, | ||
54 | arm_per_div, ahb_per_div, ipg_per, uart_sel, uart_div, esdhc_sel, | ||
55 | esdhc1_div, esdhc2_div, esdhc3_div, spdif_sel, spdif_div_pre, | ||
56 | spdif_div_post, ssi_sel, ssi1_div_pre, ssi1_div_post, ssi2_div_pre, | ||
57 | ssi2_div_post, usb_sel, usb_div, nfc_div, asrc_gate, pata_gate, | ||
58 | audmux_gate, can1_gate, can2_gate, cspi1_gate, cspi2_gate, ect_gate, | ||
59 | edio_gate, emi_gate, epit1_gate, epit2_gate, esai_gate, esdhc1_gate, | ||
60 | esdhc2_gate, esdhc3_gate, fec_gate, gpio1_gate, gpio2_gate, gpio3_gate, | ||
61 | gpt_gate, i2c1_gate, i2c2_gate, i2c3_gate, iomuxc_gate, ipu_gate, | ||
62 | kpp_gate, mlb_gate, mshc_gate, owire_gate, pwm_gate, rngc_gate, | ||
63 | rtc_gate, rtic_gate, scc_gate, sdma_gate, spba_gate, spdif_gate, | ||
64 | ssi1_gate, ssi2_gate, uart1_gate, uart2_gate, uart3_gate, usbotg_gate, | ||
65 | wdog_gate, max_gate, admux_gate, csi_gate, iim_gate, gpu2d_gate, | ||
66 | clk_max | ||
67 | }; | ||
68 | |||
69 | static struct clk *clk[clk_max]; | ||
70 | |||
71 | int __init mx35_clocks_init() | ||
72 | { | ||
73 | void __iomem *base = MX35_IO_ADDRESS(MX35_CCM_BASE_ADDR); | ||
74 | u32 pdr0, consumer_sel, hsp_sel; | ||
75 | struct arm_ahb_div *aad; | ||
76 | unsigned char *hsp_div; | ||
77 | int i; | ||
78 | |||
79 | pdr0 = __raw_readl(base + MXC_CCM_PDR0); | ||
80 | consumer_sel = (pdr0 >> 16) & 0xf; | ||
81 | aad = &clk_consumer[consumer_sel]; | ||
82 | if (!aad->arm) { | ||
83 | pr_err("i.MX35 clk: illegal consumer mux selection 0x%x\n", consumer_sel); | ||
84 | /* | ||
85 | * We are basically stuck. Continue with a default entry and hope we | ||
86 | * get far enough to actually show the above message | ||
87 | */ | ||
88 | aad = &clk_consumer[0]; | ||
89 | } | ||
90 | |||
91 | clk[ckih] = imx_clk_fixed("ckih", 24000000); | ||
92 | clk[mpll] = imx_clk_pllv1("mpll", "ckih", base + MX35_CCM_MPCTL); | ||
93 | clk[ppll] = imx_clk_pllv1("ppll", "ckih", base + MX35_CCM_PPCTL); | ||
94 | |||
95 | clk[mpll] = imx_clk_fixed_factor("mpll_075", "mpll", 3, 4); | ||
96 | |||
97 | if (aad->sel) | ||
98 | clk[arm] = imx_clk_fixed_factor("arm", "mpll_075", 1, aad->arm); | ||
99 | else | ||
100 | clk[arm] = imx_clk_fixed_factor("arm", "mpll", 1, aad->arm); | ||
101 | |||
102 | if (clk_get_rate(clk[arm]) > 400000000) | ||
103 | hsp_div = hsp_div_532; | ||
104 | else | ||
105 | hsp_div = hsp_div_400; | ||
106 | |||
107 | hsp_sel = (pdr0 >> 20) & 0x3; | ||
108 | if (!hsp_div[hsp_sel]) { | ||
109 | pr_err("i.MX35 clk: illegal hsp clk selection 0x%x\n", hsp_sel); | ||
110 | hsp_sel = 0; | ||
111 | } | ||
112 | |||
113 | clk[hsp] = imx_clk_fixed_factor("hsp", "arm", 1, hsp_div[hsp_sel]); | ||
114 | |||
115 | clk[ahb] = imx_clk_fixed_factor("ahb", "arm", 1, aad->ahb); | ||
116 | clk[ipg] = imx_clk_fixed_factor("ipg", "ahb", 1, 2); | ||
117 | |||
118 | clk[arm_per_div] = imx_clk_divider("arm_per_div", "arm", base + MX35_CCM_PDR4, 16, 6); | ||
119 | clk[ahb_per_div] = imx_clk_divider("ahb_per_div", "ahb", base + MXC_CCM_PDR0, 12, 3); | ||
120 | clk[ipg_per] = imx_clk_mux("ipg_per", base + MXC_CCM_PDR0, 26, 1, ipg_per_sel, ARRAY_SIZE(ipg_per_sel)); | ||
121 | |||
122 | clk[uart_sel] = imx_clk_mux("uart_sel", base + MX35_CCM_PDR3, 14, 1, std_sel, ARRAY_SIZE(std_sel)); | ||
123 | clk[uart_div] = imx_clk_divider("uart_div", "uart_sel", base + MX35_CCM_PDR4, 10, 6); | ||
124 | |||
125 | clk[esdhc_sel] = imx_clk_mux("esdhc_sel", base + MX35_CCM_PDR4, 9, 1, std_sel, ARRAY_SIZE(std_sel)); | ||
126 | clk[esdhc1_div] = imx_clk_divider("esdhc1_div", "esdhc_sel", base + MX35_CCM_PDR3, 0, 6); | ||
127 | clk[esdhc2_div] = imx_clk_divider("esdhc2_div", "esdhc_sel", base + MX35_CCM_PDR3, 8, 6); | ||
128 | clk[esdhc3_div] = imx_clk_divider("esdhc3_div", "esdhc_sel", base + MX35_CCM_PDR3, 16, 6); | ||
129 | |||
130 | clk[spdif_sel] = imx_clk_mux("spdif_sel", base + MX35_CCM_PDR3, 22, 1, std_sel, ARRAY_SIZE(std_sel)); | ||
131 | clk[spdif_div_pre] = imx_clk_divider("spdif_div_pre", "spdif_sel", base + MX35_CCM_PDR3, 29, 3); /* divide by 1 not allowed */ | ||
132 | clk[spdif_div_post] = imx_clk_divider("spdif_div_post", "spdif_div_pre", base + MX35_CCM_PDR3, 23, 6); | ||
133 | |||
134 | clk[ssi_sel] = imx_clk_mux("ssi_sel", base + MX35_CCM_PDR2, 6, 1, std_sel, ARRAY_SIZE(std_sel)); | ||
135 | clk[ssi1_div_pre] = imx_clk_divider("ssi1_div_pre", "ssi_sel", base + MX35_CCM_PDR2, 24, 3); | ||
136 | clk[ssi1_div_post] = imx_clk_divider("ssi1_div_post", "ssi1_div_pre", base + MX35_CCM_PDR2, 0, 6); | ||
137 | clk[ssi2_div_pre] = imx_clk_divider("ssi2_div_pre", "ssi_sel", base + MX35_CCM_PDR2, 27, 3); | ||
138 | clk[ssi2_div_post] = imx_clk_divider("ssi2_div_post", "ssi2_div_pre", base + MX35_CCM_PDR2, 8, 6); | ||
139 | |||
140 | clk[usb_sel] = imx_clk_mux("usb_sel", base + MX35_CCM_PDR4, 9, 1, std_sel, ARRAY_SIZE(std_sel)); | ||
141 | clk[usb_div] = imx_clk_divider("usb_div", "usb_sel", base + MX35_CCM_PDR4, 22, 6); | ||
142 | |||
143 | clk[nfc_div] = imx_clk_divider("nfc_div", "ahb", base + MX35_CCM_PDR4, 28, 4); | ||
144 | |||
145 | clk[asrc_gate] = imx_clk_gate2("asrc_gate", "ipg", base + MX35_CCM_CGR0, 0); | ||
146 | clk[pata_gate] = imx_clk_gate2("pata_gate", "ipg", base + MX35_CCM_CGR0, 2); | ||
147 | clk[audmux_gate] = imx_clk_gate2("audmux_gate", "ipg", base + MX35_CCM_CGR0, 4); | ||
148 | clk[can1_gate] = imx_clk_gate2("can1_gate", "ipg", base + MX35_CCM_CGR0, 6); | ||
149 | clk[can2_gate] = imx_clk_gate2("can2_gate", "ipg", base + MX35_CCM_CGR0, 8); | ||
150 | clk[cspi1_gate] = imx_clk_gate2("cspi1_gate", "ipg", base + MX35_CCM_CGR0, 10); | ||
151 | clk[cspi2_gate] = imx_clk_gate2("cspi2_gate", "ipg", base + MX35_CCM_CGR0, 12); | ||
152 | clk[ect_gate] = imx_clk_gate2("ect_gate", "ipg", base + MX35_CCM_CGR0, 14); | ||
153 | clk[edio_gate] = imx_clk_gate2("edio_gate", "ipg", base + MX35_CCM_CGR0, 16); | ||
154 | clk[emi_gate] = imx_clk_gate2("emi_gate", "ipg", base + MX35_CCM_CGR0, 18); | ||
155 | clk[epit1_gate] = imx_clk_gate2("epit1_gate", "ipg", base + MX35_CCM_CGR0, 20); | ||
156 | clk[epit2_gate] = imx_clk_gate2("epit2_gate", "ipg", base + MX35_CCM_CGR0, 22); | ||
157 | clk[esai_gate] = imx_clk_gate2("esai_gate", "ipg", base + MX35_CCM_CGR0, 24); | ||
158 | clk[esdhc1_gate] = imx_clk_gate2("esdhc1_gate", "esdhc1_div", base + MX35_CCM_CGR0, 26); | ||
159 | clk[esdhc2_gate] = imx_clk_gate2("esdhc2_gate", "esdhc2_div", base + MX35_CCM_CGR0, 28); | ||
160 | clk[esdhc3_gate] = imx_clk_gate2("esdhc3_gate", "esdhc3_div", base + MX35_CCM_CGR0, 30); | ||
161 | |||
162 | clk[fec_gate] = imx_clk_gate2("fec_gate", "ipg", base + MX35_CCM_CGR1, 0); | ||
163 | clk[gpio1_gate] = imx_clk_gate2("gpio1_gate", "ipg", base + MX35_CCM_CGR1, 2); | ||
164 | clk[gpio2_gate] = imx_clk_gate2("gpio2_gate", "ipg", base + MX35_CCM_CGR1, 4); | ||
165 | clk[gpio3_gate] = imx_clk_gate2("gpio3_gate", "ipg", base + MX35_CCM_CGR1, 6); | ||
166 | clk[gpt_gate] = imx_clk_gate2("gpt_gate", "ipg", base + MX35_CCM_CGR1, 8); | ||
167 | clk[i2c1_gate] = imx_clk_gate2("i2c1_gate", "ipg_per", base + MX35_CCM_CGR1, 10); | ||
168 | clk[i2c2_gate] = imx_clk_gate2("i2c2_gate", "ipg_per", base + MX35_CCM_CGR1, 12); | ||
169 | clk[i2c3_gate] = imx_clk_gate2("i2c3_gate", "ipg_per", base + MX35_CCM_CGR1, 14); | ||
170 | clk[iomuxc_gate] = imx_clk_gate2("iomuxc_gate", "ipg", base + MX35_CCM_CGR1, 16); | ||
171 | clk[ipu_gate] = imx_clk_gate2("ipu_gate", "hsp", base + MX35_CCM_CGR1, 18); | ||
172 | clk[kpp_gate] = imx_clk_gate2("kpp_gate", "ipg", base + MX35_CCM_CGR1, 20); | ||
173 | clk[mlb_gate] = imx_clk_gate2("mlb_gate", "ahb", base + MX35_CCM_CGR1, 22); | ||
174 | clk[mshc_gate] = imx_clk_gate2("mshc_gate", "dummy", base + MX35_CCM_CGR1, 24); | ||
175 | clk[owire_gate] = imx_clk_gate2("owire_gate", "ipg_per", base + MX35_CCM_CGR1, 26); | ||
176 | clk[pwm_gate] = imx_clk_gate2("pwm_gate", "ipg_per", base + MX35_CCM_CGR1, 28); | ||
177 | clk[rngc_gate] = imx_clk_gate2("rngc_gate", "ipg", base + MX35_CCM_CGR1, 30); | ||
178 | |||
179 | clk[rtc_gate] = imx_clk_gate2("rtc_gate", "ipg", base + MX35_CCM_CGR2, 0); | ||
180 | clk[rtic_gate] = imx_clk_gate2("rtic_gate", "ahb", base + MX35_CCM_CGR2, 2); | ||
181 | clk[scc_gate] = imx_clk_gate2("scc_gate", "ipg", base + MX35_CCM_CGR2, 4); | ||
182 | clk[sdma_gate] = imx_clk_gate2("sdma_gate", "ahb", base + MX35_CCM_CGR2, 6); | ||
183 | clk[spba_gate] = imx_clk_gate2("spba_gate", "ipg", base + MX35_CCM_CGR2, 8); | ||
184 | clk[spdif_gate] = imx_clk_gate2("spdif_gate", "spdif_div_post", base + MX35_CCM_CGR2, 10); | ||
185 | clk[ssi1_gate] = imx_clk_gate2("ssi1_gate", "ssi1_div_post", base + MX35_CCM_CGR2, 12); | ||
186 | clk[ssi2_gate] = imx_clk_gate2("ssi2_gate", "ssi2_div_post", base + MX35_CCM_CGR2, 14); | ||
187 | clk[uart1_gate] = imx_clk_gate2("uart1_gate", "uart_div", base + MX35_CCM_CGR2, 16); | ||
188 | clk[uart2_gate] = imx_clk_gate2("uart2_gate", "uart_div", base + MX35_CCM_CGR2, 18); | ||
189 | clk[uart3_gate] = imx_clk_gate2("uart3_gate", "uart_div", base + MX35_CCM_CGR2, 20); | ||
190 | clk[usbotg_gate] = imx_clk_gate2("usbotg_gate", "ahb", base + MX35_CCM_CGR2, 22); | ||
191 | clk[wdog_gate] = imx_clk_gate2("wdog_gate", "ipg", base + MX35_CCM_CGR2, 24); | ||
192 | clk[max_gate] = imx_clk_gate2("max_gate", "dummy", base + MX35_CCM_CGR2, 26); | ||
193 | clk[admux_gate] = imx_clk_gate2("admux_gate", "ipg", base + MX35_CCM_CGR2, 30); | ||
194 | |||
195 | clk[csi_gate] = imx_clk_gate2("csi_gate", "ipg", base + MX35_CCM_CGR3, 0); | ||
196 | clk[iim_gate] = imx_clk_gate2("iim_gate", "ipg", base + MX35_CCM_CGR3, 2); | ||
197 | clk[gpu2d_gate] = imx_clk_gate2("gpu2d_gate", "ahb", base + MX35_CCM_CGR3, 4); | ||
198 | |||
199 | for (i = 0; i < ARRAY_SIZE(clk); i++) | ||
200 | if (IS_ERR(clk[i])) | ||
201 | pr_err("i.MX35 clk %d: register failed with %ld\n", | ||
202 | i, PTR_ERR(clk[i])); | ||
203 | |||
204 | |||
205 | clk_register_clkdev(clk[pata_gate], NULL, "pata_imx"); | ||
206 | clk_register_clkdev(clk[can1_gate], NULL, "flexcan.0"); | ||
207 | clk_register_clkdev(clk[can2_gate], NULL, "flexcan.1"); | ||
208 | clk_register_clkdev(clk[cspi1_gate], "per", "imx35-cspi.0"); | ||
209 | clk_register_clkdev(clk[cspi1_gate], "ipg", "imx35-cspi.0"); | ||
210 | clk_register_clkdev(clk[cspi2_gate], "per", "imx35-cspi.1"); | ||
211 | clk_register_clkdev(clk[cspi2_gate], "ipg", "imx35-cspi.1"); | ||
212 | clk_register_clkdev(clk[epit1_gate], NULL, "imx-epit.0"); | ||
213 | clk_register_clkdev(clk[epit2_gate], NULL, "imx-epit.1"); | ||
214 | clk_register_clkdev(clk[esdhc1_gate], "per", "sdhci-esdhc-imx35.0"); | ||
215 | clk_register_clkdev(clk[ipg], "ipg", "sdhci-esdhc-imx35.0"); | ||
216 | clk_register_clkdev(clk[ahb], "ahb", "sdhci-esdhc-imx35.0"); | ||
217 | clk_register_clkdev(clk[esdhc2_gate], "per", "sdhci-esdhc-imx35.1"); | ||
218 | clk_register_clkdev(clk[ipg], "ipg", "sdhci-esdhc-imx35.1"); | ||
219 | clk_register_clkdev(clk[ahb], "ahb", "sdhci-esdhc-imx35.1"); | ||
220 | clk_register_clkdev(clk[esdhc3_gate], "per", "sdhci-esdhc-imx35.2"); | ||
221 | clk_register_clkdev(clk[ipg], "ipg", "sdhci-esdhc-imx35.2"); | ||
222 | clk_register_clkdev(clk[ahb], "ahb", "sdhci-esdhc-imx35.2"); | ||
223 | /* i.mx35 has the i.mx27 type fec */ | ||
224 | clk_register_clkdev(clk[fec_gate], NULL, "imx27-fec.0"); | ||
225 | clk_register_clkdev(clk[gpt_gate], "per", "imx-gpt.0"); | ||
226 | clk_register_clkdev(clk[ipg], "ipg", "imx-gpt.0"); | ||
227 | clk_register_clkdev(clk[i2c1_gate], NULL, "imx-i2c.0"); | ||
228 | clk_register_clkdev(clk[i2c2_gate], NULL, "imx-i2c.1"); | ||
229 | clk_register_clkdev(clk[i2c3_gate], NULL, "imx-i2c.2"); | ||
230 | clk_register_clkdev(clk[ipu_gate], NULL, "ipu-core"); | ||
231 | clk_register_clkdev(clk[ipu_gate], NULL, "mx3_sdc_fb"); | ||
232 | clk_register_clkdev(clk[owire_gate], NULL, "mxc_w1"); | ||
233 | clk_register_clkdev(clk[sdma_gate], NULL, "imx35-sdma"); | ||
234 | clk_register_clkdev(clk[ipg], "ipg", "imx-ssi.0"); | ||
235 | clk_register_clkdev(clk[ssi1_div_post], "per", "imx-ssi.0"); | ||
236 | clk_register_clkdev(clk[ipg], "ipg", "imx-ssi.1"); | ||
237 | clk_register_clkdev(clk[ssi2_div_post], "per", "imx-ssi.1"); | ||
238 | /* i.mx35 has the i.mx21 type uart */ | ||
239 | clk_register_clkdev(clk[uart1_gate], "per", "imx21-uart.0"); | ||
240 | clk_register_clkdev(clk[ipg], "ipg", "imx21-uart.0"); | ||
241 | clk_register_clkdev(clk[uart2_gate], "per", "imx21-uart.1"); | ||
242 | clk_register_clkdev(clk[ipg], "ipg", "imx21-uart.1"); | ||
243 | clk_register_clkdev(clk[uart3_gate], "per", "imx21-uart.2"); | ||
244 | clk_register_clkdev(clk[ipg], "ipg", "imx21-uart.2"); | ||
245 | clk_register_clkdev(clk[usb_div], "per", "mxc-ehci.0"); | ||
246 | clk_register_clkdev(clk[ipg], "ipg", "mxc-ehci.0"); | ||
247 | clk_register_clkdev(clk[usbotg_gate], "ahb", "mxc-ehci.0"); | ||
248 | clk_register_clkdev(clk[usb_div], "per", "mxc-ehci.1"); | ||
249 | clk_register_clkdev(clk[ipg], "ipg", "mxc-ehci.1"); | ||
250 | clk_register_clkdev(clk[usbotg_gate], "ahb", "mxc-ehci.1"); | ||
251 | clk_register_clkdev(clk[usb_div], "per", "mxc-ehci.2"); | ||
252 | clk_register_clkdev(clk[ipg], "ipg", "mxc-ehci.2"); | ||
253 | clk_register_clkdev(clk[usbotg_gate], "ahb", "mxc-ehci.2"); | ||
254 | clk_register_clkdev(clk[usb_div], "per", "fsl-usb2-udc"); | ||
255 | clk_register_clkdev(clk[ipg], "ipg", "fsl-usb2-udc"); | ||
256 | clk_register_clkdev(clk[usbotg_gate], "ahb", "fsl-usb2-udc"); | ||
257 | clk_register_clkdev(clk[wdog_gate], NULL, "imx2-wdt.0"); | ||
258 | clk_register_clkdev(clk[nfc_div], NULL, "mxc_nand.0"); | ||
259 | |||
260 | clk_prepare_enable(clk[spba_gate]); | ||
261 | clk_prepare_enable(clk[gpio1_gate]); | ||
262 | clk_prepare_enable(clk[gpio2_gate]); | ||
263 | clk_prepare_enable(clk[gpio3_gate]); | ||
264 | clk_prepare_enable(clk[iim_gate]); | ||
265 | clk_prepare_enable(clk[emi_gate]); | ||
266 | |||
267 | imx_print_silicon_rev("i.MX35", mx35_revision()); | ||
268 | |||
269 | #ifdef CONFIG_MXC_USE_EPIT | ||
270 | epit_timer_init(&epit1_clk, | ||
271 | MX35_IO_ADDRESS(MX35_EPIT1_BASE_ADDR), MX35_INT_EPIT1); | ||
272 | #else | ||
273 | mxc_timer_init(NULL, MX35_IO_ADDRESS(MX35_GPT1_BASE_ADDR), | ||
274 | MX35_INT_GPT); | ||
275 | #endif | ||
276 | |||
277 | return 0; | ||
278 | } | ||
diff --git a/arch/arm/mach-imx/clk-imx51-imx53.c b/arch/arm/mach-imx/clk-imx51-imx53.c new file mode 100644 index 000000000000..b8a382defb23 --- /dev/null +++ b/arch/arm/mach-imx/clk-imx51-imx53.c | |||
@@ -0,0 +1,466 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2011 Sascha Hauer, Pengutronix <s.hauer@pengutronix.de> | ||
3 | * | ||
4 | * This program is free software; you can redistribute it and/or modify | ||
5 | * it under the terms of the GNU General Public License version 2 as | ||
6 | * published by the Free Software Foundation. | ||
7 | * | ||
8 | */ | ||
9 | #include <linux/mm.h> | ||
10 | #include <linux/delay.h> | ||
11 | #include <linux/clk.h> | ||
12 | #include <linux/io.h> | ||
13 | #include <linux/clkdev.h> | ||
14 | #include <linux/of.h> | ||
15 | #include <linux/err.h> | ||
16 | |||
17 | #include <mach/hardware.h> | ||
18 | #include <mach/common.h> | ||
19 | |||
20 | #include "crm-regs-imx5.h" | ||
21 | #include "clk.h" | ||
22 | |||
23 | /* Low-power Audio Playback Mode clock */ | ||
24 | static const char *lp_apm_sel[] = { "osc", }; | ||
25 | |||
26 | /* This is used multiple times */ | ||
27 | static const char *standard_pll_sel[] = { "pll1_sw", "pll2_sw", "pll3_sw", "lp_apm", }; | ||
28 | static const char *periph_apm_sel[] = { "pll1_sw", "pll3_sw", "lp_apm", }; | ||
29 | static const char *main_bus_sel[] = { "pll2_sw", "periph_apm", }; | ||
30 | static const char *per_lp_apm_sel[] = { "main_bus", "lp_apm", }; | ||
31 | static const char *per_root_sel[] = { "per_podf", "ipg", }; | ||
32 | static const char *esdhc_c_sel[] = { "esdhc_a_podf", "esdhc_b_podf", }; | ||
33 | static const char *esdhc_d_sel[] = { "esdhc_a_podf", "esdhc_b_podf", }; | ||
34 | static const char *emi_slow_sel[] = { "main_bus", "ahb", }; | ||
35 | static const char *usb_phy_sel_str[] = { "osc", "usb_phy_podf", }; | ||
36 | static const char *mx51_ipu_di0_sel[] = { "di_pred", "osc", "ckih1", "tve_di", }; | ||
37 | static const char *mx53_ipu_di0_sel[] = { "di_pred", "osc", "ckih1", "di_pll4_podf", "dummy", "ldb_di0", }; | ||
38 | static const char *mx53_ldb_di0_sel[] = { "pll3_sw", "pll4_sw", }; | ||
39 | static const char *mx51_ipu_di1_sel[] = { "di_pred", "osc", "ckih1", "tve_di", "ipp_di1", }; | ||
40 | static const char *mx53_ipu_di1_sel[] = { "di_pred", "osc", "ckih1", "tve_di", "ipp_di1", "ldb_di1", }; | ||
41 | static const char *mx53_ldb_di1_sel[] = { "pll3_sw", "pll4_sw", }; | ||
42 | static const char *mx51_tve_ext_sel[] = { "osc", "ckih1", }; | ||
43 | static const char *mx53_tve_ext_sel[] = { "pll4_sw", "ckih1", }; | ||
44 | static const char *tve_sel[] = { "tve_pred", "tve_ext_sel", }; | ||
45 | static const char *ipu_sel[] = { "axi_a", "axi_b", "emi_slow_gate", "ahb", }; | ||
46 | static const char *vpu_sel[] = { "axi_a", "axi_b", "emi_slow_gate", "ahb", }; | ||
47 | |||
48 | enum imx5_clks { | ||
49 | dummy, ckil, osc, ckih1, ckih2, ahb, ipg, axi_a, axi_b, uart_pred, | ||
50 | uart_root, esdhc_a_pred, esdhc_b_pred, esdhc_c_s, esdhc_d_s, | ||
51 | emi_sel, emi_slow_podf, nfc_podf, ecspi_pred, ecspi_podf, usboh3_pred, | ||
52 | usboh3_podf, usb_phy_pred, usb_phy_podf, cpu_podf, di_pred, tve_di, | ||
53 | tve_s, uart1_ipg_gate, uart1_per_gate, uart2_ipg_gate, | ||
54 | uart2_per_gate, uart3_ipg_gate, uart3_per_gate, i2c1_gate, i2c2_gate, | ||
55 | gpt_ipg_gate, pwm1_ipg_gate, pwm1_hf_gate, pwm2_ipg_gate, pwm2_hf_gate, | ||
56 | gpt_gate, fec_gate, usboh3_per_gate, esdhc1_ipg_gate, esdhc2_ipg_gate, | ||
57 | esdhc3_ipg_gate, esdhc4_ipg_gate, ssi1_ipg_gate, ssi2_ipg_gate, | ||
58 | ssi3_ipg_gate, ecspi1_ipg_gate, ecspi1_per_gate, ecspi2_ipg_gate, | ||
59 | ecspi2_per_gate, cspi_ipg_gate, sdma_gate, emi_slow_gate, ipu_s, | ||
60 | ipu_gate, nfc_gate, ipu_di1_gate, vpu_s, vpu_gate, | ||
61 | vpu_reference_gate, uart4_ipg_gate, uart4_per_gate, uart5_ipg_gate, | ||
62 | uart5_per_gate, tve_gate, tve_pred, esdhc1_per_gate, esdhc2_per_gate, | ||
63 | esdhc3_per_gate, esdhc4_per_gate, usb_phy_gate, hsi2c_gate, | ||
64 | mipi_hsc1_gate, mipi_hsc2_gate, mipi_esc_gate, mipi_hsp_gate, | ||
65 | ldb_di1_div_3_5, ldb_di1_div, ldb_di0_div_3_5, ldb_di0_div, | ||
66 | ldb_di1_gate, can2_serial_gate, can2_ipg_gate, i2c3_gate, lp_apm, | ||
67 | periph_apm, main_bus, ahb_max, aips_tz1, aips_tz2, tmax1, tmax2, | ||
68 | tmax3, spba, uart_sel, esdhc_a_sel, esdhc_b_sel, esdhc_a_podf, | ||
69 | esdhc_b_podf, ecspi_sel, usboh3_sel, usb_phy_sel, iim_gate, | ||
70 | usboh3_gate, emi_fast_gate, ipu_di0_gate,gpc_dvfs, pll1_sw, pll2_sw, | ||
71 | pll3_sw, ipu_di0_sel, ipu_di1_sel, tve_ext_sel, mx51_mipi, pll4_sw, | ||
72 | ldb_di1_sel, di_pll4_podf, ldb_di0_sel, ldb_di0_gate, usb_phy1_gate, | ||
73 | usb_phy2_gate, per_lp_apm, per_pred1, per_pred2, per_podf, per_root, | ||
74 | clk_max | ||
75 | }; | ||
76 | |||
77 | static struct clk *clk[clk_max]; | ||
78 | |||
79 | static void __init mx5_clocks_common_init(unsigned long rate_ckil, | ||
80 | unsigned long rate_osc, unsigned long rate_ckih1, | ||
81 | unsigned long rate_ckih2) | ||
82 | { | ||
83 | int i; | ||
84 | |||
85 | clk[dummy] = imx_clk_fixed("dummy", 0); | ||
86 | clk[ckil] = imx_clk_fixed("ckil", rate_ckil); | ||
87 | clk[osc] = imx_clk_fixed("osc", rate_osc); | ||
88 | clk[ckih1] = imx_clk_fixed("ckih1", rate_ckih1); | ||
89 | clk[ckih2] = imx_clk_fixed("ckih2", rate_ckih2); | ||
90 | |||
91 | clk[lp_apm] = imx_clk_mux("lp_apm", MXC_CCM_CCSR, 9, 1, | ||
92 | lp_apm_sel, ARRAY_SIZE(lp_apm_sel)); | ||
93 | clk[periph_apm] = imx_clk_mux("periph_apm", MXC_CCM_CBCMR, 12, 2, | ||
94 | periph_apm_sel, ARRAY_SIZE(periph_apm_sel)); | ||
95 | clk[main_bus] = imx_clk_mux("main_bus", MXC_CCM_CBCDR, 25, 1, | ||
96 | main_bus_sel, ARRAY_SIZE(main_bus_sel)); | ||
97 | clk[per_lp_apm] = imx_clk_mux("per_lp_apm", MXC_CCM_CBCDR, 1, 1, | ||
98 | per_lp_apm_sel, ARRAY_SIZE(per_lp_apm_sel)); | ||
99 | clk[per_pred1] = imx_clk_divider("per_pred1", "per_lp_apm", MXC_CCM_CBCDR, 6, 2); | ||
100 | clk[per_pred2] = imx_clk_divider("per_pred2", "per_pred1", MXC_CCM_CBCDR, 3, 3); | ||
101 | clk[per_podf] = imx_clk_divider("per_podf", "per_pred2", MXC_CCM_CBCDR, 0, 3); | ||
102 | clk[per_root] = imx_clk_mux("per_root", MXC_CCM_CBCDR, 1, 0, | ||
103 | per_root_sel, ARRAY_SIZE(per_root_sel)); | ||
104 | clk[ahb] = imx_clk_divider("ahb", "main_bus", MXC_CCM_CBCDR, 10, 3); | ||
105 | clk[ahb_max] = imx_clk_gate2("ahb_max", "ahb", MXC_CCM_CCGR0, 28); | ||
106 | clk[aips_tz1] = imx_clk_gate2("aips_tz1", "ahb", MXC_CCM_CCGR0, 24); | ||
107 | clk[aips_tz2] = imx_clk_gate2("aips_tz2", "ahb", MXC_CCM_CCGR0, 26); | ||
108 | clk[tmax1] = imx_clk_gate2("tmax1", "ahb", MXC_CCM_CCGR1, 0); | ||
109 | clk[tmax2] = imx_clk_gate2("tmax2", "ahb", MXC_CCM_CCGR1, 2); | ||
110 | clk[tmax3] = imx_clk_gate2("tmax3", "ahb", MXC_CCM_CCGR1, 4); | ||
111 | clk[spba] = imx_clk_gate2("spba", "ipg", MXC_CCM_CCGR5, 0); | ||
112 | clk[ipg] = imx_clk_divider("ipg", "ahb", MXC_CCM_CBCDR, 8, 2); | ||
113 | clk[axi_a] = imx_clk_divider("axi_a", "main_bus", MXC_CCM_CBCDR, 16, 3); | ||
114 | clk[axi_b] = imx_clk_divider("axi_b", "main_bus", MXC_CCM_CBCDR, 19, 3); | ||
115 | clk[uart_sel] = imx_clk_mux("uart_sel", MXC_CCM_CSCMR1, 24, 2, | ||
116 | standard_pll_sel, ARRAY_SIZE(standard_pll_sel)); | ||
117 | clk[uart_pred] = imx_clk_divider("uart_pred", "uart_sel", MXC_CCM_CSCDR1, 3, 3); | ||
118 | clk[uart_root] = imx_clk_divider("uart_root", "uart_pred", MXC_CCM_CSCDR1, 0, 3); | ||
119 | |||
120 | clk[esdhc_a_sel] = imx_clk_mux("esdhc_a_sel", MXC_CCM_CSCMR1, 20, 2, | ||
121 | standard_pll_sel, ARRAY_SIZE(standard_pll_sel)); | ||
122 | clk[esdhc_b_sel] = imx_clk_mux("esdhc_b_sel", MXC_CCM_CSCMR1, 16, 2, | ||
123 | standard_pll_sel, ARRAY_SIZE(standard_pll_sel)); | ||
124 | clk[esdhc_a_pred] = imx_clk_divider("esdhc_a_pred", "esdhc_a_sel", MXC_CCM_CSCDR1, 16, 3); | ||
125 | clk[esdhc_a_podf] = imx_clk_divider("esdhc_a_podf", "esdhc_a_pred", MXC_CCM_CSCDR1, 11, 3); | ||
126 | clk[esdhc_b_pred] = imx_clk_divider("esdhc_b_pred", "esdhc_b_sel", MXC_CCM_CSCDR1, 22, 3); | ||
127 | clk[esdhc_b_podf] = imx_clk_divider("esdhc_b_podf", "esdhc_b_pred", MXC_CCM_CSCDR1, 19, 3); | ||
128 | clk[esdhc_c_s] = imx_clk_mux("esdhc_c_sel", MXC_CCM_CSCMR1, 19, 1, esdhc_c_sel, ARRAY_SIZE(esdhc_c_sel)); | ||
129 | clk[esdhc_d_s] = imx_clk_mux("esdhc_d_sel", MXC_CCM_CSCMR1, 18, 1, esdhc_d_sel, ARRAY_SIZE(esdhc_d_sel)); | ||
130 | |||
131 | clk[emi_sel] = imx_clk_mux("emi_sel", MXC_CCM_CBCDR, 26, 1, | ||
132 | emi_slow_sel, ARRAY_SIZE(emi_slow_sel)); | ||
133 | clk[emi_slow_podf] = imx_clk_divider("emi_slow_podf", "emi_sel", MXC_CCM_CBCDR, 22, 3); | ||
134 | clk[nfc_podf] = imx_clk_divider("nfc_podf", "emi_slow_podf", MXC_CCM_CBCDR, 13, 3); | ||
135 | clk[ecspi_sel] = imx_clk_mux("ecspi_sel", MXC_CCM_CSCMR1, 4, 2, | ||
136 | standard_pll_sel, ARRAY_SIZE(standard_pll_sel)); | ||
137 | clk[ecspi_pred] = imx_clk_divider("ecspi_pred", "ecspi_sel", MXC_CCM_CSCDR2, 25, 3); | ||
138 | clk[ecspi_podf] = imx_clk_divider("ecspi_podf", "ecspi_pred", MXC_CCM_CSCDR2, 19, 6); | ||
139 | clk[usboh3_sel] = imx_clk_mux("usboh3_sel", MXC_CCM_CSCMR1, 22, 2, | ||
140 | standard_pll_sel, ARRAY_SIZE(standard_pll_sel)); | ||
141 | clk[usboh3_pred] = imx_clk_divider("usboh3_pred", "usboh3_sel", MXC_CCM_CSCDR1, 8, 3); | ||
142 | clk[usboh3_podf] = imx_clk_divider("usboh3_podf", "usboh3_pred", MXC_CCM_CSCDR1, 6, 2); | ||
143 | clk[usb_phy_pred] = imx_clk_divider("usb_phy_pred", "pll3_sw", MXC_CCM_CDCDR, 3, 3); | ||
144 | clk[usb_phy_podf] = imx_clk_divider("usb_phy_podf", "usb_phy_pred", MXC_CCM_CDCDR, 0, 3); | ||
145 | clk[usb_phy_sel] = imx_clk_mux("usb_phy_sel", MXC_CCM_CSCMR1, 26, 1, | ||
146 | usb_phy_sel_str, ARRAY_SIZE(usb_phy_sel_str)); | ||
147 | clk[cpu_podf] = imx_clk_divider("cpu_podf", "pll1_sw", MXC_CCM_CACRR, 0, 3); | ||
148 | clk[di_pred] = imx_clk_divider("di_pred", "pll3_sw", MXC_CCM_CDCDR, 6, 3); | ||
149 | clk[tve_di] = imx_clk_fixed("tve_di", 65000000); /* FIXME */ | ||
150 | clk[tve_s] = imx_clk_mux("tve_sel", MXC_CCM_CSCMR1, 7, 1, tve_sel, ARRAY_SIZE(tve_sel)); | ||
151 | clk[iim_gate] = imx_clk_gate2("iim_gate", "ipg", MXC_CCM_CCGR0, 30); | ||
152 | clk[uart1_ipg_gate] = imx_clk_gate2("uart1_ipg_gate", "ipg", MXC_CCM_CCGR1, 6); | ||
153 | clk[uart1_per_gate] = imx_clk_gate2("uart1_per_gate", "uart_root", MXC_CCM_CCGR1, 8); | ||
154 | clk[uart2_ipg_gate] = imx_clk_gate2("uart2_ipg_gate", "ipg", MXC_CCM_CCGR1, 10); | ||
155 | clk[uart2_per_gate] = imx_clk_gate2("uart2_per_gate", "uart_root", MXC_CCM_CCGR1, 12); | ||
156 | clk[uart3_ipg_gate] = imx_clk_gate2("uart3_ipg_gate", "ipg", MXC_CCM_CCGR1, 14); | ||
157 | clk[uart3_per_gate] = imx_clk_gate2("uart3_per_gate", "uart_root", MXC_CCM_CCGR1, 16); | ||
158 | clk[i2c1_gate] = imx_clk_gate2("i2c1_gate", "per_root", MXC_CCM_CCGR1, 18); | ||
159 | clk[i2c2_gate] = imx_clk_gate2("i2c2_gate", "per_root", MXC_CCM_CCGR1, 20); | ||
160 | clk[gpt_ipg_gate] = imx_clk_gate2("gpt_ipg_gate", "ipg", MXC_CCM_CCGR2, 20); | ||
161 | clk[pwm1_ipg_gate] = imx_clk_gate2("pwm1_ipg_gate", "ipg", MXC_CCM_CCGR2, 10); | ||
162 | clk[pwm1_hf_gate] = imx_clk_gate2("pwm1_hf_gate", "ipg", MXC_CCM_CCGR2, 12); | ||
163 | clk[pwm2_ipg_gate] = imx_clk_gate2("pwm2_ipg_gate", "ipg", MXC_CCM_CCGR2, 14); | ||
164 | clk[pwm2_hf_gate] = imx_clk_gate2("pwm2_hf_gate", "ipg", MXC_CCM_CCGR2, 16); | ||
165 | clk[gpt_gate] = imx_clk_gate2("gpt_gate", "ipg", MXC_CCM_CCGR2, 18); | ||
166 | clk[fec_gate] = imx_clk_gate2("fec_gate", "ipg", MXC_CCM_CCGR2, 24); | ||
167 | clk[usboh3_gate] = imx_clk_gate2("usboh3_gate", "ipg", MXC_CCM_CCGR2, 26); | ||
168 | clk[usboh3_per_gate] = imx_clk_gate2("usboh3_per_gate", "usboh3_podf", MXC_CCM_CCGR2, 28); | ||
169 | clk[esdhc1_ipg_gate] = imx_clk_gate2("esdhc1_ipg_gate", "ipg", MXC_CCM_CCGR3, 0); | ||
170 | clk[esdhc2_ipg_gate] = imx_clk_gate2("esdhc2_ipg_gate", "ipg", MXC_CCM_CCGR3, 4); | ||
171 | clk[esdhc3_ipg_gate] = imx_clk_gate2("esdhc3_ipg_gate", "ipg", MXC_CCM_CCGR3, 8); | ||
172 | clk[esdhc4_ipg_gate] = imx_clk_gate2("esdhc4_ipg_gate", "ipg", MXC_CCM_CCGR3, 12); | ||
173 | clk[ssi1_ipg_gate] = imx_clk_gate2("ssi1_ipg_gate", "ipg", MXC_CCM_CCGR3, 16); | ||
174 | clk[ssi2_ipg_gate] = imx_clk_gate2("ssi2_ipg_gate", "ipg", MXC_CCM_CCGR3, 20); | ||
175 | clk[ssi3_ipg_gate] = imx_clk_gate2("ssi3_ipg_gate", "ipg", MXC_CCM_CCGR3, 24); | ||
176 | clk[ecspi1_ipg_gate] = imx_clk_gate2("ecspi1_ipg_gate", "ipg", MXC_CCM_CCGR4, 18); | ||
177 | clk[ecspi1_per_gate] = imx_clk_gate2("ecspi1_per_gate", "ecspi_podf", MXC_CCM_CCGR4, 20); | ||
178 | clk[ecspi2_ipg_gate] = imx_clk_gate2("ecspi2_ipg_gate", "ipg", MXC_CCM_CCGR4, 22); | ||
179 | clk[ecspi2_per_gate] = imx_clk_gate2("ecspi2_per_gate", "ecspi_podf", MXC_CCM_CCGR4, 24); | ||
180 | clk[cspi_ipg_gate] = imx_clk_gate2("cspi_ipg_gate", "ipg", MXC_CCM_CCGR4, 26); | ||
181 | clk[sdma_gate] = imx_clk_gate2("sdma_gate", "ipg", MXC_CCM_CCGR4, 30); | ||
182 | clk[emi_fast_gate] = imx_clk_gate2("emi_fast_gate", "dummy", MXC_CCM_CCGR5, 14); | ||
183 | clk[emi_slow_gate] = imx_clk_gate2("emi_slow_gate", "emi_slow_podf", MXC_CCM_CCGR5, 16); | ||
184 | clk[ipu_s] = imx_clk_mux("ipu_sel", MXC_CCM_CBCMR, 6, 2, ipu_sel, ARRAY_SIZE(ipu_sel)); | ||
185 | clk[ipu_gate] = imx_clk_gate2("ipu_gate", "ipu_sel", MXC_CCM_CCGR5, 10); | ||
186 | clk[nfc_gate] = imx_clk_gate2("nfc_gate", "nfc_podf", MXC_CCM_CCGR5, 20); | ||
187 | clk[ipu_di0_gate] = imx_clk_gate2("ipu_di0_gate", "ipu_di0_sel", MXC_CCM_CCGR6, 10); | ||
188 | clk[ipu_di1_gate] = imx_clk_gate2("ipu_di1_gate", "ipu_di1_sel", MXC_CCM_CCGR6, 12); | ||
189 | clk[vpu_s] = imx_clk_mux("vpu_sel", MXC_CCM_CBCMR, 14, 2, vpu_sel, ARRAY_SIZE(vpu_sel)); | ||
190 | clk[vpu_gate] = imx_clk_gate2("vpu_gate", "vpu_sel", MXC_CCM_CCGR5, 6); | ||
191 | clk[vpu_reference_gate] = imx_clk_gate2("vpu_reference_gate", "osc", MXC_CCM_CCGR5, 8); | ||
192 | clk[uart4_ipg_gate] = imx_clk_gate2("uart4_ipg_gate", "ipg", MXC_CCM_CCGR7, 8); | ||
193 | clk[uart4_per_gate] = imx_clk_gate2("uart4_per_gate", "uart_root", MXC_CCM_CCGR7, 10); | ||
194 | clk[uart5_ipg_gate] = imx_clk_gate2("uart5_ipg_gate", "ipg", MXC_CCM_CCGR7, 12); | ||
195 | clk[uart5_per_gate] = imx_clk_gate2("uart5_per_gate", "uart_root", MXC_CCM_CCGR7, 14); | ||
196 | clk[gpc_dvfs] = imx_clk_gate2("gpc_dvfs", "dummy", MXC_CCM_CCGR5, 24); | ||
197 | |||
198 | for (i = 0; i < ARRAY_SIZE(clk); i++) | ||
199 | if (IS_ERR(clk[i])) | ||
200 | pr_err("i.MX5 clk %d: register failed with %ld\n", | ||
201 | i, PTR_ERR(clk[i])); | ||
202 | |||
203 | clk_register_clkdev(clk[gpt_gate], "per", "imx-gpt.0"); | ||
204 | clk_register_clkdev(clk[gpt_ipg_gate], "ipg", "imx-gpt.0"); | ||
205 | clk_register_clkdev(clk[uart1_per_gate], "per", "imx21-uart.0"); | ||
206 | clk_register_clkdev(clk[uart1_ipg_gate], "ipg", "imx21-uart.0"); | ||
207 | clk_register_clkdev(clk[uart2_per_gate], "per", "imx21-uart.1"); | ||
208 | clk_register_clkdev(clk[uart2_ipg_gate], "ipg", "imx21-uart.1"); | ||
209 | clk_register_clkdev(clk[uart3_per_gate], "per", "imx21-uart.2"); | ||
210 | clk_register_clkdev(clk[uart3_ipg_gate], "ipg", "imx21-uart.2"); | ||
211 | clk_register_clkdev(clk[uart4_per_gate], "per", "imx21-uart.3"); | ||
212 | clk_register_clkdev(clk[uart4_ipg_gate], "ipg", "imx21-uart.3"); | ||
213 | clk_register_clkdev(clk[uart5_per_gate], "per", "imx21-uart.4"); | ||
214 | clk_register_clkdev(clk[uart5_ipg_gate], "ipg", "imx21-uart.4"); | ||
215 | clk_register_clkdev(clk[ecspi1_per_gate], "per", "imx51-ecspi.0"); | ||
216 | clk_register_clkdev(clk[ecspi1_ipg_gate], "ipg", "imx51-ecspi.0"); | ||
217 | clk_register_clkdev(clk[ecspi2_per_gate], "per", "imx51-ecspi.1"); | ||
218 | clk_register_clkdev(clk[ecspi2_ipg_gate], "ipg", "imx51-ecspi.1"); | ||
219 | clk_register_clkdev(clk[cspi_ipg_gate], NULL, "imx51-cspi.0"); | ||
220 | clk_register_clkdev(clk[pwm1_ipg_gate], "pwm", "mxc_pwm.0"); | ||
221 | clk_register_clkdev(clk[pwm2_ipg_gate], "pwm", "mxc_pwm.1"); | ||
222 | clk_register_clkdev(clk[i2c1_gate], NULL, "imx-i2c.0"); | ||
223 | clk_register_clkdev(clk[i2c2_gate], NULL, "imx-i2c.1"); | ||
224 | clk_register_clkdev(clk[usboh3_per_gate], "per", "mxc-ehci.0"); | ||
225 | clk_register_clkdev(clk[usboh3_gate], "ipg", "mxc-ehci.0"); | ||
226 | clk_register_clkdev(clk[usboh3_gate], "ahb", "mxc-ehci.0"); | ||
227 | clk_register_clkdev(clk[usboh3_per_gate], "per", "mxc-ehci.1"); | ||
228 | clk_register_clkdev(clk[usboh3_gate], "ipg", "mxc-ehci.1"); | ||
229 | clk_register_clkdev(clk[usboh3_gate], "ahb", "mxc-ehci.1"); | ||
230 | clk_register_clkdev(clk[usboh3_per_gate], "per", "mxc-ehci.2"); | ||
231 | clk_register_clkdev(clk[usboh3_gate], "ipg", "mxc-ehci.2"); | ||
232 | clk_register_clkdev(clk[usboh3_gate], "ahb", "mxc-ehci.2"); | ||
233 | clk_register_clkdev(clk[usboh3_per_gate], "per", "fsl-usb2-udc"); | ||
234 | clk_register_clkdev(clk[usboh3_gate], "ipg", "fsl-usb2-udc"); | ||
235 | clk_register_clkdev(clk[usboh3_gate], "ahb", "fsl-usb2-udc"); | ||
236 | clk_register_clkdev(clk[nfc_gate], NULL, "mxc_nand"); | ||
237 | clk_register_clkdev(clk[ssi1_ipg_gate], NULL, "imx-ssi.0"); | ||
238 | clk_register_clkdev(clk[ssi2_ipg_gate], NULL, "imx-ssi.1"); | ||
239 | clk_register_clkdev(clk[ssi3_ipg_gate], NULL, "imx-ssi.2"); | ||
240 | clk_register_clkdev(clk[sdma_gate], NULL, "imx35-sdma"); | ||
241 | clk_register_clkdev(clk[cpu_podf], "cpu", NULL); | ||
242 | clk_register_clkdev(clk[iim_gate], "iim", NULL); | ||
243 | clk_register_clkdev(clk[dummy], NULL, "imx2-wdt.0"); | ||
244 | clk_register_clkdev(clk[dummy], NULL, "imx2-wdt.1"); | ||
245 | clk_register_clkdev(clk[dummy], NULL, "imx-keypad"); | ||
246 | clk_register_clkdev(clk[tve_gate], NULL, "imx-tve.0"); | ||
247 | clk_register_clkdev(clk[ipu_di1_gate], "di1", "imx-tve.0"); | ||
248 | |||
249 | /* Set SDHC parents to be PLL2 */ | ||
250 | clk_set_parent(clk[esdhc_a_sel], clk[pll2_sw]); | ||
251 | clk_set_parent(clk[esdhc_b_sel], clk[pll2_sw]); | ||
252 | |||
253 | /* move usb phy clk to 24MHz */ | ||
254 | clk_set_parent(clk[usb_phy_sel], clk[osc]); | ||
255 | |||
256 | clk_prepare_enable(clk[gpc_dvfs]); | ||
257 | clk_prepare_enable(clk[ahb_max]); /* esdhc3 */ | ||
258 | clk_prepare_enable(clk[aips_tz1]); | ||
259 | clk_prepare_enable(clk[aips_tz2]); /* fec */ | ||
260 | clk_prepare_enable(clk[spba]); | ||
261 | clk_prepare_enable(clk[emi_fast_gate]); /* fec */ | ||
262 | clk_prepare_enable(clk[tmax1]); | ||
263 | clk_prepare_enable(clk[tmax2]); /* esdhc2, fec */ | ||
264 | clk_prepare_enable(clk[tmax3]); /* esdhc1, esdhc4 */ | ||
265 | } | ||
266 | |||
267 | int __init mx51_clocks_init(unsigned long rate_ckil, unsigned long rate_osc, | ||
268 | unsigned long rate_ckih1, unsigned long rate_ckih2) | ||
269 | { | ||
270 | int i; | ||
271 | |||
272 | clk[pll1_sw] = imx_clk_pllv2("pll1_sw", "osc", MX51_DPLL1_BASE); | ||
273 | clk[pll2_sw] = imx_clk_pllv2("pll2_sw", "osc", MX51_DPLL2_BASE); | ||
274 | clk[pll3_sw] = imx_clk_pllv2("pll3_sw", "osc", MX51_DPLL3_BASE); | ||
275 | clk[ipu_di0_sel] = imx_clk_mux("ipu_di0_sel", MXC_CCM_CSCMR2, 26, 3, | ||
276 | mx51_ipu_di0_sel, ARRAY_SIZE(mx51_ipu_di0_sel)); | ||
277 | clk[ipu_di1_sel] = imx_clk_mux("ipu_di1_sel", MXC_CCM_CSCMR2, 29, 3, | ||
278 | mx51_ipu_di1_sel, ARRAY_SIZE(mx51_ipu_di1_sel)); | ||
279 | clk[tve_ext_sel] = imx_clk_mux("tve_ext_sel", MXC_CCM_CSCMR1, 6, 1, | ||
280 | mx51_tve_ext_sel, ARRAY_SIZE(mx51_tve_ext_sel)); | ||
281 | clk[tve_gate] = imx_clk_gate2("tve_gate", "tve_sel", MXC_CCM_CCGR2, 30); | ||
282 | clk[tve_pred] = imx_clk_divider("tve_pred", "pll3_sw", MXC_CCM_CDCDR, 28, 3); | ||
283 | clk[esdhc1_per_gate] = imx_clk_gate2("esdhc1_per_gate", "esdhc_a_podf", MXC_CCM_CCGR3, 2); | ||
284 | clk[esdhc2_per_gate] = imx_clk_gate2("esdhc2_per_gate", "esdhc_b_podf", MXC_CCM_CCGR3, 6); | ||
285 | clk[esdhc3_per_gate] = imx_clk_gate2("esdhc3_per_gate", "esdhc_c_sel", MXC_CCM_CCGR3, 10); | ||
286 | clk[esdhc4_per_gate] = imx_clk_gate2("esdhc4_per_gate", "esdhc_d_sel", MXC_CCM_CCGR3, 14); | ||
287 | clk[usb_phy_gate] = imx_clk_gate2("usb_phy_gate", "usb_phy_sel", MXC_CCM_CCGR2, 0); | ||
288 | clk[hsi2c_gate] = imx_clk_gate2("hsi2c_gate", "ipg", MXC_CCM_CCGR1, 22); | ||
289 | clk[mipi_hsc1_gate] = imx_clk_gate2("mipi_hsc1_gate", "ipg", MXC_CCM_CCGR4, 6); | ||
290 | clk[mipi_hsc2_gate] = imx_clk_gate2("mipi_hsc2_gate", "ipg", MXC_CCM_CCGR4, 8); | ||
291 | clk[mipi_esc_gate] = imx_clk_gate2("mipi_esc_gate", "ipg", MXC_CCM_CCGR4, 10); | ||
292 | clk[mipi_hsp_gate] = imx_clk_gate2("mipi_hsp_gate", "ipg", MXC_CCM_CCGR4, 12); | ||
293 | |||
294 | for (i = 0; i < ARRAY_SIZE(clk); i++) | ||
295 | if (IS_ERR(clk[i])) | ||
296 | pr_err("i.MX51 clk %d: register failed with %ld\n", | ||
297 | i, PTR_ERR(clk[i])); | ||
298 | |||
299 | mx5_clocks_common_init(rate_ckil, rate_osc, rate_ckih1, rate_ckih2); | ||
300 | |||
301 | clk_register_clkdev(clk[hsi2c_gate], NULL, "imx-i2c.2"); | ||
302 | clk_register_clkdev(clk[mx51_mipi], "mipi_hsp", NULL); | ||
303 | clk_register_clkdev(clk[vpu_gate], NULL, "imx51-vpu.0"); | ||
304 | clk_register_clkdev(clk[fec_gate], NULL, "imx27-fec.0"); | ||
305 | clk_register_clkdev(clk[gpc_dvfs], "gpc_dvfs", NULL); | ||
306 | clk_register_clkdev(clk[ipu_gate], "bus", "imx51-ipu"); | ||
307 | clk_register_clkdev(clk[ipu_di0_gate], "di0", "imx51-ipu"); | ||
308 | clk_register_clkdev(clk[ipu_di1_gate], "di1", "imx51-ipu"); | ||
309 | clk_register_clkdev(clk[ipu_gate], "hsp", "imx51-ipu"); | ||
310 | clk_register_clkdev(clk[usb_phy_gate], "phy", "mxc-ehci.0"); | ||
311 | clk_register_clkdev(clk[esdhc1_ipg_gate], "ipg", "sdhci-esdhc-imx51.0"); | ||
312 | clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx51.0"); | ||
313 | clk_register_clkdev(clk[esdhc1_per_gate], "per", "sdhci-esdhc-imx51.0"); | ||
314 | clk_register_clkdev(clk[esdhc2_ipg_gate], "ipg", "sdhci-esdhc-imx51.1"); | ||
315 | clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx51.1"); | ||
316 | clk_register_clkdev(clk[esdhc2_per_gate], "per", "sdhci-esdhc-imx51.1"); | ||
317 | clk_register_clkdev(clk[esdhc3_ipg_gate], "ipg", "sdhci-esdhc-imx51.2"); | ||
318 | clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx51.2"); | ||
319 | clk_register_clkdev(clk[esdhc3_per_gate], "per", "sdhci-esdhc-imx51.2"); | ||
320 | clk_register_clkdev(clk[esdhc4_ipg_gate], "ipg", "sdhci-esdhc-imx51.3"); | ||
321 | clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx51.3"); | ||
322 | clk_register_clkdev(clk[esdhc4_per_gate], "per", "sdhci-esdhc-imx51.3"); | ||
323 | |||
324 | /* set the usboh3 parent to pll2_sw */ | ||
325 | clk_set_parent(clk[usboh3_sel], clk[pll2_sw]); | ||
326 | |||
327 | /* set SDHC root clock to 166.25MHZ*/ | ||
328 | clk_set_rate(clk[esdhc_a_podf], 166250000); | ||
329 | clk_set_rate(clk[esdhc_b_podf], 166250000); | ||
330 | |||
331 | /* System timer */ | ||
332 | mxc_timer_init(NULL, MX51_IO_ADDRESS(MX51_GPT1_BASE_ADDR), | ||
333 | MX51_INT_GPT); | ||
334 | |||
335 | clk_prepare_enable(clk[iim_gate]); | ||
336 | imx_print_silicon_rev("i.MX51", mx51_revision()); | ||
337 | clk_disable_unprepare(clk[iim_gate]); | ||
338 | |||
339 | return 0; | ||
340 | } | ||
341 | |||
342 | int __init mx53_clocks_init(unsigned long rate_ckil, unsigned long rate_osc, | ||
343 | unsigned long rate_ckih1, unsigned long rate_ckih2) | ||
344 | { | ||
345 | int i; | ||
346 | unsigned long r; | ||
347 | |||
348 | clk[pll1_sw] = imx_clk_pllv2("pll1_sw", "osc", MX53_DPLL1_BASE); | ||
349 | clk[pll2_sw] = imx_clk_pllv2("pll2_sw", "osc", MX53_DPLL2_BASE); | ||
350 | clk[pll3_sw] = imx_clk_pllv2("pll3_sw", "osc", MX53_DPLL3_BASE); | ||
351 | clk[pll4_sw] = imx_clk_pllv2("pll4_sw", "osc", MX53_DPLL4_BASE); | ||
352 | |||
353 | clk[ldb_di1_sel] = imx_clk_mux("ldb_di1_sel", MXC_CCM_CSCMR2, 9, 1, | ||
354 | mx53_ldb_di1_sel, ARRAY_SIZE(mx53_ldb_di1_sel)); | ||
355 | clk[ldb_di1_div_3_5] = imx_clk_fixed_factor("ldb_di1_div_3_5", "ldb_di1_sel", 2, 7); | ||
356 | clk[ldb_di1_div] = imx_clk_divider("ldb_di1_div", "ldb_di1_div_3_5", MXC_CCM_CSCMR2, 11, 1); | ||
357 | clk[di_pll4_podf] = imx_clk_divider("di_pll4_podf", "pll4_sw", MXC_CCM_CDCDR, 16, 3); | ||
358 | clk[ldb_di0_sel] = imx_clk_mux("ldb_di0_sel", MXC_CCM_CSCMR2, 8, 1, | ||
359 | mx53_ldb_di0_sel, ARRAY_SIZE(mx53_ldb_di0_sel)); | ||
360 | clk[ldb_di0_div_3_5] = imx_clk_fixed_factor("ldb_di0_div_3_5", "ldb_di0_sel", 2, 7); | ||
361 | clk[ldb_di0_div] = imx_clk_divider("ldb_di0_div", "ldb_di0_div_3_5", MXC_CCM_CSCMR2, 10, 1); | ||
362 | clk[ldb_di0_gate] = imx_clk_gate2("ldb_di0_gate", "ldb_di0_div", MXC_CCM_CCGR6, 28); | ||
363 | clk[ldb_di1_gate] = imx_clk_gate2("ldb_di1_gate", "ldb_di1_div", MXC_CCM_CCGR6, 30); | ||
364 | clk[ipu_di0_sel] = imx_clk_mux("ipu_di0_sel", MXC_CCM_CSCMR2, 26, 3, | ||
365 | mx53_ipu_di0_sel, ARRAY_SIZE(mx53_ipu_di0_sel)); | ||
366 | clk[ipu_di1_sel] = imx_clk_mux("ipu_di1_sel", MXC_CCM_CSCMR2, 29, 3, | ||
367 | mx53_ipu_di1_sel, ARRAY_SIZE(mx53_ipu_di1_sel)); | ||
368 | clk[tve_ext_sel] = imx_clk_mux("tve_ext_sel", MXC_CCM_CSCMR1, 6, 1, | ||
369 | mx53_tve_ext_sel, ARRAY_SIZE(mx53_tve_ext_sel)); | ||
370 | clk[tve_gate] = imx_clk_gate2("tve_gate", "tve_pred", MXC_CCM_CCGR2, 30); | ||
371 | clk[tve_pred] = imx_clk_divider("tve_pred", "tve_ext_sel", MXC_CCM_CDCDR, 28, 3); | ||
372 | clk[esdhc1_per_gate] = imx_clk_gate2("esdhc1_per_gate", "esdhc_a_podf", MXC_CCM_CCGR3, 2); | ||
373 | clk[esdhc2_per_gate] = imx_clk_gate2("esdhc2_per_gate", "esdhc_c_sel", MXC_CCM_CCGR3, 6); | ||
374 | clk[esdhc3_per_gate] = imx_clk_gate2("esdhc3_per_gate", "esdhc_b_podf", MXC_CCM_CCGR3, 10); | ||
375 | clk[esdhc4_per_gate] = imx_clk_gate2("esdhc4_per_gate", "esdhc_d_sel", MXC_CCM_CCGR3, 14); | ||
376 | clk[usb_phy1_gate] = imx_clk_gate2("usb_phy1_gate", "usb_phy_sel", MXC_CCM_CCGR4, 10); | ||
377 | clk[usb_phy2_gate] = imx_clk_gate2("usb_phy2_gate", "usb_phy_sel", MXC_CCM_CCGR4, 12); | ||
378 | clk[can2_serial_gate] = imx_clk_gate2("can2_serial_gate", "ipg", MXC_CCM_CCGR4, 6); | ||
379 | clk[can2_ipg_gate] = imx_clk_gate2("can2_ipg_gate", "ipg", MXC_CCM_CCGR4, 8); | ||
380 | clk[i2c3_gate] = imx_clk_gate2("i2c3_gate", "per_root", MXC_CCM_CCGR1, 22); | ||
381 | |||
382 | for (i = 0; i < ARRAY_SIZE(clk); i++) | ||
383 | if (IS_ERR(clk[i])) | ||
384 | pr_err("i.MX53 clk %d: register failed with %ld\n", | ||
385 | i, PTR_ERR(clk[i])); | ||
386 | |||
387 | mx5_clocks_common_init(rate_ckil, rate_osc, rate_ckih1, rate_ckih2); | ||
388 | |||
389 | clk_register_clkdev(clk[vpu_gate], NULL, "imx53-vpu.0"); | ||
390 | clk_register_clkdev(clk[i2c3_gate], NULL, "imx-i2c.2"); | ||
391 | clk_register_clkdev(clk[fec_gate], NULL, "imx25-fec.0"); | ||
392 | clk_register_clkdev(clk[ipu_gate], "bus", "imx53-ipu"); | ||
393 | clk_register_clkdev(clk[ipu_di0_gate], "di0", "imx53-ipu"); | ||
394 | clk_register_clkdev(clk[ipu_di1_gate], "di1", "imx53-ipu"); | ||
395 | clk_register_clkdev(clk[ipu_gate], "hsp", "imx53-ipu"); | ||
396 | clk_register_clkdev(clk[usb_phy1_gate], "usb_phy1", "mxc-ehci.0"); | ||
397 | clk_register_clkdev(clk[esdhc1_ipg_gate], "ipg", "sdhci-esdhc-imx53.0"); | ||
398 | clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx53.0"); | ||
399 | clk_register_clkdev(clk[esdhc1_per_gate], "per", "sdhci-esdhc-imx53.0"); | ||
400 | clk_register_clkdev(clk[esdhc2_ipg_gate], "ipg", "sdhci-esdhc-imx53.1"); | ||
401 | clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx53.1"); | ||
402 | clk_register_clkdev(clk[esdhc2_per_gate], "per", "sdhci-esdhc-imx53.1"); | ||
403 | clk_register_clkdev(clk[esdhc3_ipg_gate], "ipg", "sdhci-esdhc-imx53.2"); | ||
404 | clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx53.2"); | ||
405 | clk_register_clkdev(clk[esdhc3_per_gate], "per", "sdhci-esdhc-imx53.2"); | ||
406 | clk_register_clkdev(clk[esdhc4_ipg_gate], "ipg", "sdhci-esdhc-imx53.3"); | ||
407 | clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx53.3"); | ||
408 | clk_register_clkdev(clk[esdhc4_per_gate], "per", "sdhci-esdhc-imx53.3"); | ||
409 | |||
410 | /* set SDHC root clock to 200MHZ*/ | ||
411 | clk_set_rate(clk[esdhc_a_podf], 200000000); | ||
412 | clk_set_rate(clk[esdhc_b_podf], 200000000); | ||
413 | |||
414 | /* System timer */ | ||
415 | mxc_timer_init(NULL, MX53_IO_ADDRESS(MX53_GPT1_BASE_ADDR), | ||
416 | MX53_INT_GPT); | ||
417 | |||
418 | clk_prepare_enable(clk[iim_gate]); | ||
419 | imx_print_silicon_rev("i.MX53", mx53_revision()); | ||
420 | clk_disable_unprepare(clk[iim_gate]); | ||
421 | |||
422 | r = clk_round_rate(clk[usboh3_per_gate], 54000000); | ||
423 | clk_set_rate(clk[usboh3_per_gate], r); | ||
424 | |||
425 | return 0; | ||
426 | } | ||
427 | |||
428 | #ifdef CONFIG_OF | ||
429 | static void __init clk_get_freq_dt(unsigned long *ckil, unsigned long *osc, | ||
430 | unsigned long *ckih1, unsigned long *ckih2) | ||
431 | { | ||
432 | struct device_node *np; | ||
433 | |||
434 | /* retrieve the freqency of fixed clocks from device tree */ | ||
435 | for_each_compatible_node(np, NULL, "fixed-clock") { | ||
436 | u32 rate; | ||
437 | if (of_property_read_u32(np, "clock-frequency", &rate)) | ||
438 | continue; | ||
439 | |||
440 | if (of_device_is_compatible(np, "fsl,imx-ckil")) | ||
441 | *ckil = rate; | ||
442 | else if (of_device_is_compatible(np, "fsl,imx-osc")) | ||
443 | *osc = rate; | ||
444 | else if (of_device_is_compatible(np, "fsl,imx-ckih1")) | ||
445 | *ckih1 = rate; | ||
446 | else if (of_device_is_compatible(np, "fsl,imx-ckih2")) | ||
447 | *ckih2 = rate; | ||
448 | } | ||
449 | } | ||
450 | |||
451 | int __init mx51_clocks_init_dt(void) | ||
452 | { | ||
453 | unsigned long ckil, osc, ckih1, ckih2; | ||
454 | |||
455 | clk_get_freq_dt(&ckil, &osc, &ckih1, &ckih2); | ||
456 | return mx51_clocks_init(ckil, osc, ckih1, ckih2); | ||
457 | } | ||
458 | |||
459 | int __init mx53_clocks_init_dt(void) | ||
460 | { | ||
461 | unsigned long ckil, osc, ckih1, ckih2; | ||
462 | |||
463 | clk_get_freq_dt(&ckil, &osc, &ckih1, &ckih2); | ||
464 | return mx53_clocks_init(ckil, osc, ckih1, ckih2); | ||
465 | } | ||
466 | #endif | ||
diff --git a/arch/arm/mach-imx/clk-imx6q.c b/arch/arm/mach-imx/clk-imx6q.c new file mode 100644 index 000000000000..f40a35da2e5c --- /dev/null +++ b/arch/arm/mach-imx/clk-imx6q.c | |||
@@ -0,0 +1,439 @@ | |||
1 | /* | ||
2 | * Copyright 2011 Freescale Semiconductor, Inc. | ||
3 | * Copyright 2011 Linaro Ltd. | ||
4 | * | ||
5 | * The code contained herein is licensed under the GNU General Public | ||
6 | * License. You may obtain a copy of the GNU General Public License | ||
7 | * Version 2 or later at the following locations: | ||
8 | * | ||
9 | * http://www.opensource.org/licenses/gpl-license.html | ||
10 | * http://www.gnu.org/copyleft/gpl.html | ||
11 | */ | ||
12 | |||
13 | #include <linux/init.h> | ||
14 | #include <linux/types.h> | ||
15 | #include <linux/clk.h> | ||
16 | #include <linux/clkdev.h> | ||
17 | #include <linux/err.h> | ||
18 | #include <linux/io.h> | ||
19 | #include <linux/of.h> | ||
20 | #include <linux/of_address.h> | ||
21 | #include <linux/of_irq.h> | ||
22 | #include <mach/common.h> | ||
23 | #include "clk.h" | ||
24 | |||
25 | #define CCGR0 0x68 | ||
26 | #define CCGR1 0x6c | ||
27 | #define CCGR2 0x70 | ||
28 | #define CCGR3 0x74 | ||
29 | #define CCGR4 0x78 | ||
30 | #define CCGR5 0x7c | ||
31 | #define CCGR6 0x80 | ||
32 | #define CCGR7 0x84 | ||
33 | |||
34 | #define CLPCR 0x54 | ||
35 | #define BP_CLPCR_LPM 0 | ||
36 | #define BM_CLPCR_LPM (0x3 << 0) | ||
37 | #define BM_CLPCR_BYPASS_PMIC_READY (0x1 << 2) | ||
38 | #define BM_CLPCR_ARM_CLK_DIS_ON_LPM (0x1 << 5) | ||
39 | #define BM_CLPCR_SBYOS (0x1 << 6) | ||
40 | #define BM_CLPCR_DIS_REF_OSC (0x1 << 7) | ||
41 | #define BM_CLPCR_VSTBY (0x1 << 8) | ||
42 | #define BP_CLPCR_STBY_COUNT 9 | ||
43 | #define BM_CLPCR_STBY_COUNT (0x3 << 9) | ||
44 | #define BM_CLPCR_COSC_PWRDOWN (0x1 << 11) | ||
45 | #define BM_CLPCR_WB_PER_AT_LPM (0x1 << 16) | ||
46 | #define BM_CLPCR_WB_CORE_AT_LPM (0x1 << 17) | ||
47 | #define BM_CLPCR_BYP_MMDC_CH0_LPM_HS (0x1 << 19) | ||
48 | #define BM_CLPCR_BYP_MMDC_CH1_LPM_HS (0x1 << 21) | ||
49 | #define BM_CLPCR_MASK_CORE0_WFI (0x1 << 22) | ||
50 | #define BM_CLPCR_MASK_CORE1_WFI (0x1 << 23) | ||
51 | #define BM_CLPCR_MASK_CORE2_WFI (0x1 << 24) | ||
52 | #define BM_CLPCR_MASK_CORE3_WFI (0x1 << 25) | ||
53 | #define BM_CLPCR_MASK_SCU_IDLE (0x1 << 26) | ||
54 | #define BM_CLPCR_MASK_L2CC_IDLE (0x1 << 27) | ||
55 | |||
56 | static void __iomem *ccm_base; | ||
57 | |||
58 | void __init imx6q_clock_map_io(void) { } | ||
59 | |||
60 | int imx6q_set_lpm(enum mxc_cpu_pwr_mode mode) | ||
61 | { | ||
62 | u32 val = readl_relaxed(ccm_base + CLPCR); | ||
63 | |||
64 | val &= ~BM_CLPCR_LPM; | ||
65 | switch (mode) { | ||
66 | case WAIT_CLOCKED: | ||
67 | break; | ||
68 | case WAIT_UNCLOCKED: | ||
69 | val |= 0x1 << BP_CLPCR_LPM; | ||
70 | break; | ||
71 | case STOP_POWER_ON: | ||
72 | val |= 0x2 << BP_CLPCR_LPM; | ||
73 | break; | ||
74 | case WAIT_UNCLOCKED_POWER_OFF: | ||
75 | val |= 0x1 << BP_CLPCR_LPM; | ||
76 | val &= ~BM_CLPCR_VSTBY; | ||
77 | val &= ~BM_CLPCR_SBYOS; | ||
78 | break; | ||
79 | case STOP_POWER_OFF: | ||
80 | val |= 0x2 << BP_CLPCR_LPM; | ||
81 | val |= 0x3 << BP_CLPCR_STBY_COUNT; | ||
82 | val |= BM_CLPCR_VSTBY; | ||
83 | val |= BM_CLPCR_SBYOS; | ||
84 | break; | ||
85 | default: | ||
86 | return -EINVAL; | ||
87 | } | ||
88 | |||
89 | writel_relaxed(val, ccm_base + CLPCR); | ||
90 | |||
91 | return 0; | ||
92 | } | ||
93 | |||
94 | static const char *step_sels[] = { "osc", "pll2_pfd2_396m", }; | ||
95 | static const char *pll1_sw_sels[] = { "pll1_sys", "step", }; | ||
96 | static const char *periph_pre_sels[] = { "pll2_bus", "pll2_pfd2_396m", "pll2_pfd0_352m", "pll2_198m", }; | ||
97 | static const char *periph_clk2_sels[] = { "pll3_usb_otg", "osc", }; | ||
98 | static const char *periph_sels[] = { "periph_pre", "periph_clk2", }; | ||
99 | static const char *periph2_sels[] = { "periph2_pre", "periph2_clk2", }; | ||
100 | static const char *axi_sels[] = { "periph", "pll2_pfd2_396m", "pll3_pfd1_540m", }; | ||
101 | static const char *audio_sels[] = { "pll4_audio", "pll3_pfd2_508m", "pll3_pfd3_454m", "pll3_usb_otg", }; | ||
102 | static const char *gpu_axi_sels[] = { "axi", "ahb", }; | ||
103 | static const char *gpu2d_core_sels[] = { "axi", "pll3_usb_otg", "pll2_pfd0_352m", "pll2_pfd2_396m", }; | ||
104 | static const char *gpu3d_core_sels[] = { "mmdc_ch0_axi", "pll3_usb_otg", "pll2_pfd1_594m", "pll2_pfd2_396m", }; | ||
105 | static const char *gpu3d_shader_sels[] = { "mmdc_ch0_axi", "pll3_usb_otg", "pll2_pfd1_594m", "pll2_pfd9_720m", }; | ||
106 | static const char *ipu_sels[] = { "mmdc_ch0_axi", "pll2_pfd2_396m", "pll3_120m", "pll3_pfd1_540m", }; | ||
107 | static const char *ldb_di_sels[] = { "pll5_video", "pll2_pfd0_352m", "pll2_pfd2_396m", "pll3_pfd1_540m", }; | ||
108 | static const char *ipu_di_pre_sels[] = { "mmdc_ch0_axi", "pll3_usb_otg", "pll5_video", "pll2_pfd0_352m", "pll2_pfd2_396m", "pll3_pfd1_540m", }; | ||
109 | static const char *ipu1_di0_sels[] = { "ipu1_di0_pre", "dummy", "dummy", "ldb_di0", "ldb_di1", }; | ||
110 | static const char *ipu1_di1_sels[] = { "ipu1_di1_pre", "dummy", "dummy", "ldb_di0", "ldb_di1", }; | ||
111 | static const char *ipu2_di0_sels[] = { "ipu2_di0_pre", "dummy", "dummy", "ldb_di0", "ldb_di1", }; | ||
112 | static const char *ipu2_di1_sels[] = { "ipu2_di1_pre", "dummy", "dummy", "ldb_di0", "ldb_di1", }; | ||
113 | static const char *hsi_tx_sels[] = { "pll3_120m", "pll2_pfd2_396m", }; | ||
114 | static const char *pcie_axi_sels[] = { "axi", "ahb", }; | ||
115 | static const char *ssi_sels[] = { "pll3_pfd2_508m", "pll3_pfd3_454m", "pll4_audio", }; | ||
116 | static const char *usdhc_sels[] = { "pll2_pfd2_396m", "pll2_pfd0_352m", }; | ||
117 | static const char *enfc_sels[] = { "pll2_pfd0_352m", "pll2_bus", "pll3_usb_otg", "pll2_pfd2_396m", }; | ||
118 | static const char *emi_sels[] = { "axi", "pll3_usb_otg", "pll2_pfd2_396m", "pll2_pfd0_352m", }; | ||
119 | static const char *vdo_axi_sels[] = { "axi", "ahb", }; | ||
120 | static const char *vpu_axi_sels[] = { "axi", "pll2_pfd2_396m", "pll2_pfd0_352m", }; | ||
121 | static const char *cko1_sels[] = { "pll3_usb_otg", "pll2_bus", "pll1_sys", "pll5_video", | ||
122 | "dummy", "axi", "enfc", "ipu1_di0", "ipu1_di1", "ipu2_di0", | ||
123 | "ipu2_di1", "ahb", "ipg", "ipg_per", "ckil", "pll4_audio", }; | ||
124 | |||
125 | static const char * const clks_init_on[] __initconst = { | ||
126 | "mmdc_ch0_axi", "mmdc_ch1_axi", "usboh3", | ||
127 | }; | ||
128 | |||
129 | enum mx6q_clks { | ||
130 | dummy, ckil, ckih, osc, pll2_pfd0_352m, pll2_pfd1_594m, pll2_pfd2_396m, | ||
131 | pll3_pfd0_720m, pll3_pfd1_540m, pll3_pfd2_508m, pll3_pfd3_454m, | ||
132 | pll2_198m, pll3_120m, pll3_80m, pll3_60m, twd, step, pll1_sw, | ||
133 | periph_pre, periph2_pre, periph_clk2_sel, periph2_clk2_sel, axi_sel, | ||
134 | esai_sel, asrc_sel, spdif_sel, gpu2d_axi, gpu3d_axi, gpu2d_core_sel, | ||
135 | gpu3d_core_sel, gpu3d_shader_sel, ipu1_sel, ipu2_sel, ldb_di0_sel, | ||
136 | ldb_di1_sel, ipu1_di0_pre_sel, ipu1_di1_pre_sel, ipu2_di0_pre_sel, | ||
137 | ipu2_di1_pre_sel, ipu1_di0_sel, ipu1_di1_sel, ipu2_di0_sel, | ||
138 | ipu2_di1_sel, hsi_tx_sel, pcie_axi_sel, ssi1_sel, ssi2_sel, ssi3_sel, | ||
139 | usdhc1_sel, usdhc2_sel, usdhc3_sel, usdhc4_sel, enfc_sel, emi_sel, | ||
140 | emi_slow_sel, vdo_axi_sel, vpu_axi_sel, cko1_sel, periph, periph2, | ||
141 | periph_clk2, periph2_clk2, ipg, ipg_per, esai_pred, esai_podf, | ||
142 | asrc_pred, asrc_podf, spdif_pred, spdif_podf, can_root, ecspi_root, | ||
143 | gpu2d_core_podf, gpu3d_core_podf, gpu3d_shader, ipu1_podf, ipu2_podf, | ||
144 | ldb_di0_podf, ldb_di1_podf, ipu1_di0_pre, ipu1_di1_pre, ipu2_di0_pre, | ||
145 | ipu2_di1_pre, hsi_tx_podf, ssi1_pred, ssi1_podf, ssi2_pred, ssi2_podf, | ||
146 | ssi3_pred, ssi3_podf, uart_serial_podf, usdhc1_podf, usdhc2_podf, | ||
147 | usdhc3_podf, usdhc4_podf, enfc_pred, enfc_podf, emi_podf, | ||
148 | emi_slow_podf, vpu_axi_podf, cko1_podf, axi, mmdc_ch0_axi_podf, | ||
149 | mmdc_ch1_axi_podf, arm, ahb, apbh_dma, asrc, can1_ipg, can1_serial, | ||
150 | can2_ipg, can2_serial, ecspi1, ecspi2, ecspi3, ecspi4, ecspi5, enet, | ||
151 | esai, gpt_ipg, gpt_ipg_per, gpu2d_core, gpu3d_core, hdmi_iahb, | ||
152 | hdmi_isfr, i2c1, i2c2, i2c3, iim, enfc, ipu1, ipu1_di0, ipu1_di1, ipu2, | ||
153 | ipu2_di0, ldb_di0, ldb_di1, ipu2_di1, hsi_tx, mlb, mmdc_ch0_axi, | ||
154 | mmdc_ch1_axi, ocram, openvg_axi, pcie_axi, pwm1, pwm2, pwm3, pwm4, | ||
155 | gpmi_bch_apb, gpmi_bch, gpmi_io, gpmi_apb, sata, sdma, spba, ssi1, | ||
156 | ssi2, ssi3, uart_ipg, uart_serial, usboh3, usdhc1, usdhc2, usdhc3, | ||
157 | usdhc4, vdo_axi, vpu_axi, cko1, pll1_sys, pll2_bus, pll3_usb_otg, | ||
158 | pll4_audio, pll5_video, pll6_mlb, pll7_usb_host, pll8_enet, clk_max | ||
159 | }; | ||
160 | |||
161 | static struct clk *clk[clk_max]; | ||
162 | |||
163 | int __init mx6q_clocks_init(void) | ||
164 | { | ||
165 | struct device_node *np; | ||
166 | void __iomem *base; | ||
167 | struct clk *c; | ||
168 | int i, irq; | ||
169 | |||
170 | clk[dummy] = imx_clk_fixed("dummy", 0); | ||
171 | |||
172 | /* retrieve the freqency of fixed clocks from device tree */ | ||
173 | for_each_compatible_node(np, NULL, "fixed-clock") { | ||
174 | u32 rate; | ||
175 | if (of_property_read_u32(np, "clock-frequency", &rate)) | ||
176 | continue; | ||
177 | |||
178 | if (of_device_is_compatible(np, "fsl,imx-ckil")) | ||
179 | clk[ckil] = imx_clk_fixed("ckil", rate); | ||
180 | else if (of_device_is_compatible(np, "fsl,imx-ckih1")) | ||
181 | clk[ckih] = imx_clk_fixed("ckih", rate); | ||
182 | else if (of_device_is_compatible(np, "fsl,imx-osc")) | ||
183 | clk[osc] = imx_clk_fixed("osc", rate); | ||
184 | } | ||
185 | |||
186 | np = of_find_compatible_node(NULL, NULL, "fsl,imx6q-anatop"); | ||
187 | base = of_iomap(np, 0); | ||
188 | WARN_ON(!base); | ||
189 | |||
190 | /* type name parent_name base gate_mask div_mask */ | ||
191 | clk[pll1_sys] = imx_clk_pllv3(IMX_PLLV3_SYS, "pll1_sys", "osc", base, 0x2000, 0x7f); | ||
192 | clk[pll2_bus] = imx_clk_pllv3(IMX_PLLV3_GENERIC, "pll2_bus", "osc", base + 0x30, 0x2000, 0x1); | ||
193 | clk[pll3_usb_otg] = imx_clk_pllv3(IMX_PLLV3_USB, "pll3_usb_otg", "osc", base + 0x10, 0x2000, 0x3); | ||
194 | clk[pll4_audio] = imx_clk_pllv3(IMX_PLLV3_AV, "pll4_audio", "osc", base + 0x70, 0x2000, 0x7f); | ||
195 | clk[pll5_video] = imx_clk_pllv3(IMX_PLLV3_AV, "pll5_video", "osc", base + 0xa0, 0x2000, 0x7f); | ||
196 | clk[pll6_mlb] = imx_clk_pllv3(IMX_PLLV3_MLB, "pll6_mlb", "osc", base + 0xd0, 0x2000, 0x0); | ||
197 | clk[pll7_usb_host] = imx_clk_pllv3(IMX_PLLV3_USB, "pll7_usb_host","osc", base + 0x20, 0x2000, 0x3); | ||
198 | clk[pll8_enet] = imx_clk_pllv3(IMX_PLLV3_ENET, "pll8_enet", "osc", base + 0xe0, 0x182000, 0x3); | ||
199 | |||
200 | /* name parent_name reg idx */ | ||
201 | clk[pll2_pfd0_352m] = imx_clk_pfd("pll2_pfd0_352m", "pll2_bus", base + 0x100, 0); | ||
202 | clk[pll2_pfd1_594m] = imx_clk_pfd("pll2_pfd1_594m", "pll2_bus", base + 0x100, 1); | ||
203 | clk[pll2_pfd2_396m] = imx_clk_pfd("pll2_pfd2_396m", "pll2_bus", base + 0x100, 2); | ||
204 | clk[pll3_pfd0_720m] = imx_clk_pfd("pll3_pfd0_720m", "pll3_usb_otg", base + 0xf0, 0); | ||
205 | clk[pll3_pfd1_540m] = imx_clk_pfd("pll3_pfd1_540m", "pll3_usb_otg", base + 0xf0, 1); | ||
206 | clk[pll3_pfd2_508m] = imx_clk_pfd("pll3_pfd2_508m", "pll3_usb_otg", base + 0xf0, 2); | ||
207 | clk[pll3_pfd3_454m] = imx_clk_pfd("pll3_pfd3_454m", "pll3_usb_otg", base + 0xf0, 3); | ||
208 | |||
209 | /* name parent_name mult div */ | ||
210 | clk[pll2_198m] = imx_clk_fixed_factor("pll2_198m", "pll2_pfd2_396m", 1, 2); | ||
211 | clk[pll3_120m] = imx_clk_fixed_factor("pll3_120m", "pll3_usb_otg", 1, 4); | ||
212 | clk[pll3_80m] = imx_clk_fixed_factor("pll3_80m", "pll3_usb_otg", 1, 6); | ||
213 | clk[pll3_60m] = imx_clk_fixed_factor("pll3_60m", "pll3_usb_otg", 1, 8); | ||
214 | clk[twd] = imx_clk_fixed_factor("twd", "arm", 1, 2); | ||
215 | |||
216 | np = of_find_compatible_node(NULL, NULL, "fsl,imx6q-ccm"); | ||
217 | base = of_iomap(np, 0); | ||
218 | WARN_ON(!base); | ||
219 | ccm_base = base; | ||
220 | |||
221 | /* name reg shift width parent_names num_parents */ | ||
222 | clk[step] = imx_clk_mux("step", base + 0xc, 8, 1, step_sels, ARRAY_SIZE(step_sels)); | ||
223 | clk[pll1_sw] = imx_clk_mux("pll1_sw", base + 0xc, 2, 1, pll1_sw_sels, ARRAY_SIZE(pll1_sw_sels)); | ||
224 | clk[periph_pre] = imx_clk_mux("periph_pre", base + 0x18, 18, 2, periph_pre_sels, ARRAY_SIZE(periph_pre_sels)); | ||
225 | clk[periph2_pre] = imx_clk_mux("periph2_pre", base + 0x18, 21, 2, periph_pre_sels, ARRAY_SIZE(periph_pre_sels)); | ||
226 | clk[periph_clk2_sel] = imx_clk_mux("periph_clk2_sel", base + 0x18, 12, 1, periph_clk2_sels, ARRAY_SIZE(periph_clk2_sels)); | ||
227 | clk[periph2_clk2_sel] = imx_clk_mux("periph2_clk2_sel", base + 0x18, 20, 1, periph_clk2_sels, ARRAY_SIZE(periph_clk2_sels)); | ||
228 | clk[axi_sel] = imx_clk_mux("axi_sel", base + 0x14, 6, 2, axi_sels, ARRAY_SIZE(axi_sels)); | ||
229 | clk[esai_sel] = imx_clk_mux("esai_sel", base + 0x20, 19, 2, audio_sels, ARRAY_SIZE(audio_sels)); | ||
230 | clk[asrc_sel] = imx_clk_mux("asrc_sel", base + 0x30, 7, 2, audio_sels, ARRAY_SIZE(audio_sels)); | ||
231 | clk[spdif_sel] = imx_clk_mux("spdif_sel", base + 0x30, 20, 2, audio_sels, ARRAY_SIZE(audio_sels)); | ||
232 | clk[gpu2d_axi] = imx_clk_mux("gpu2d_axi", base + 0x18, 0, 1, gpu_axi_sels, ARRAY_SIZE(gpu_axi_sels)); | ||
233 | clk[gpu3d_axi] = imx_clk_mux("gpu3d_axi", base + 0x18, 1, 1, gpu_axi_sels, ARRAY_SIZE(gpu_axi_sels)); | ||
234 | clk[gpu2d_core_sel] = imx_clk_mux("gpu2d_core_sel", base + 0x18, 16, 2, gpu2d_core_sels, ARRAY_SIZE(gpu2d_core_sels)); | ||
235 | clk[gpu3d_core_sel] = imx_clk_mux("gpu3d_core_sel", base + 0x18, 4, 2, gpu3d_core_sels, ARRAY_SIZE(gpu3d_core_sels)); | ||
236 | clk[gpu3d_shader_sel] = imx_clk_mux("gpu3d_shader_sel", base + 0x18, 8, 2, gpu3d_shader_sels, ARRAY_SIZE(gpu3d_shader_sels)); | ||
237 | clk[ipu1_sel] = imx_clk_mux("ipu1_sel", base + 0x3c, 9, 2, ipu_sels, ARRAY_SIZE(ipu_sels)); | ||
238 | clk[ipu2_sel] = imx_clk_mux("ipu2_sel", base + 0x3c, 14, 2, ipu_sels, ARRAY_SIZE(ipu_sels)); | ||
239 | clk[ldb_di0_sel] = imx_clk_mux("ldb_di0_sel", base + 0x2c, 9, 3, ldb_di_sels, ARRAY_SIZE(ldb_di_sels)); | ||
240 | clk[ldb_di1_sel] = imx_clk_mux("ldb_di1_sel", base + 0x2c, 12, 3, ldb_di_sels, ARRAY_SIZE(ldb_di_sels)); | ||
241 | clk[ipu1_di0_pre_sel] = imx_clk_mux("ipu1_di0_pre_sel", base + 0x34, 6, 3, ipu_di_pre_sels, ARRAY_SIZE(ipu_di_pre_sels)); | ||
242 | clk[ipu1_di1_pre_sel] = imx_clk_mux("ipu1_di1_pre_sel", base + 0x34, 15, 3, ipu_di_pre_sels, ARRAY_SIZE(ipu_di_pre_sels)); | ||
243 | clk[ipu2_di0_pre_sel] = imx_clk_mux("ipu2_di0_pre_sel", base + 0x38, 6, 3, ipu_di_pre_sels, ARRAY_SIZE(ipu_di_pre_sels)); | ||
244 | clk[ipu2_di1_pre_sel] = imx_clk_mux("ipu2_di1_pre_sel", base + 0x38, 15, 3, ipu_di_pre_sels, ARRAY_SIZE(ipu_di_pre_sels)); | ||
245 | clk[ipu1_di0_sel] = imx_clk_mux("ipu1_di0_sel", base + 0x34, 0, 3, ipu1_di0_sels, ARRAY_SIZE(ipu1_di0_sels)); | ||
246 | clk[ipu1_di1_sel] = imx_clk_mux("ipu1_di1_sel", base + 0x34, 9, 3, ipu1_di1_sels, ARRAY_SIZE(ipu1_di1_sels)); | ||
247 | clk[ipu2_di0_sel] = imx_clk_mux("ipu2_di0_sel", base + 0x38, 0, 3, ipu2_di0_sels, ARRAY_SIZE(ipu2_di0_sels)); | ||
248 | clk[ipu2_di1_sel] = imx_clk_mux("ipu2_di1_sel", base + 0x38, 9, 3, ipu2_di1_sels, ARRAY_SIZE(ipu2_di1_sels)); | ||
249 | clk[hsi_tx_sel] = imx_clk_mux("hsi_tx_sel", base + 0x30, 28, 1, hsi_tx_sels, ARRAY_SIZE(hsi_tx_sels)); | ||
250 | clk[pcie_axi_sel] = imx_clk_mux("pcie_axi_sel", base + 0x18, 10, 1, pcie_axi_sels, ARRAY_SIZE(pcie_axi_sels)); | ||
251 | clk[ssi1_sel] = imx_clk_mux("ssi1_sel", base + 0x1c, 10, 2, ssi_sels, ARRAY_SIZE(ssi_sels)); | ||
252 | clk[ssi2_sel] = imx_clk_mux("ssi2_sel", base + 0x1c, 12, 2, ssi_sels, ARRAY_SIZE(ssi_sels)); | ||
253 | clk[ssi3_sel] = imx_clk_mux("ssi3_sel", base + 0x1c, 14, 2, ssi_sels, ARRAY_SIZE(ssi_sels)); | ||
254 | clk[usdhc1_sel] = imx_clk_mux("usdhc1_sel", base + 0x1c, 16, 1, usdhc_sels, ARRAY_SIZE(usdhc_sels)); | ||
255 | clk[usdhc2_sel] = imx_clk_mux("usdhc2_sel", base + 0x1c, 17, 1, usdhc_sels, ARRAY_SIZE(usdhc_sels)); | ||
256 | clk[usdhc3_sel] = imx_clk_mux("usdhc3_sel", base + 0x1c, 18, 1, usdhc_sels, ARRAY_SIZE(usdhc_sels)); | ||
257 | clk[usdhc4_sel] = imx_clk_mux("usdhc4_sel", base + 0x1c, 19, 1, usdhc_sels, ARRAY_SIZE(usdhc_sels)); | ||
258 | clk[enfc_sel] = imx_clk_mux("enfc_sel", base + 0x2c, 16, 2, enfc_sels, ARRAY_SIZE(enfc_sels)); | ||
259 | clk[emi_sel] = imx_clk_mux("emi_sel", base + 0x1c, 27, 2, emi_sels, ARRAY_SIZE(emi_sels)); | ||
260 | clk[emi_slow_sel] = imx_clk_mux("emi_slow_sel", base + 0x1c, 29, 2, emi_sels, ARRAY_SIZE(emi_sels)); | ||
261 | clk[vdo_axi_sel] = imx_clk_mux("vdo_axi_sel", base + 0x18, 11, 1, vdo_axi_sels, ARRAY_SIZE(vdo_axi_sels)); | ||
262 | clk[vpu_axi_sel] = imx_clk_mux("vpu_axi_sel", base + 0x18, 14, 2, vpu_axi_sels, ARRAY_SIZE(vpu_axi_sels)); | ||
263 | clk[cko1_sel] = imx_clk_mux("cko1_sel", base + 0x60, 0, 4, cko1_sels, ARRAY_SIZE(cko1_sels)); | ||
264 | |||
265 | /* name reg shift width busy: reg, shift parent_names num_parents */ | ||
266 | clk[periph] = imx_clk_busy_mux("periph", base + 0x14, 25, 1, base + 0x48, 5, periph_sels, ARRAY_SIZE(periph_sels)); | ||
267 | clk[periph2] = imx_clk_busy_mux("periph2", base + 0x14, 26, 1, base + 0x48, 3, periph2_sels, ARRAY_SIZE(periph2_sels)); | ||
268 | |||
269 | /* name parent_name reg shift width */ | ||
270 | clk[periph_clk2] = imx_clk_divider("periph_clk2", "periph_clk2_sel", base + 0x14, 27, 3); | ||
271 | clk[periph2_clk2] = imx_clk_divider("periph2_clk2", "periph2_clk2_sel", base + 0x14, 0, 3); | ||
272 | clk[ipg] = imx_clk_divider("ipg", "ahb", base + 0x14, 8, 2); | ||
273 | clk[ipg_per] = imx_clk_divider("ipg_per", "ipg", base + 0x1c, 0, 6); | ||
274 | clk[esai_pred] = imx_clk_divider("esai_pred", "esai_sel", base + 0x28, 9, 3); | ||
275 | clk[esai_podf] = imx_clk_divider("esai_podf", "esai_pred", base + 0x28, 25, 3); | ||
276 | clk[asrc_pred] = imx_clk_divider("asrc_pred", "asrc_sel", base + 0x30, 12, 3); | ||
277 | clk[asrc_podf] = imx_clk_divider("asrc_podf", "asrc_pred", base + 0x30, 9, 3); | ||
278 | clk[spdif_pred] = imx_clk_divider("spdif_pred", "spdif_sel", base + 0x30, 25, 3); | ||
279 | clk[spdif_podf] = imx_clk_divider("spdif_podf", "spdif_pred", base + 0x30, 22, 3); | ||
280 | clk[can_root] = imx_clk_divider("can_root", "pll3_usb_otg", base + 0x20, 2, 6); | ||
281 | clk[ecspi_root] = imx_clk_divider("ecspi_root", "pll3_60m", base + 0x38, 19, 6); | ||
282 | clk[gpu2d_core_podf] = imx_clk_divider("gpu2d_core_podf", "gpu2d_core_sel", base + 0x18, 23, 3); | ||
283 | clk[gpu3d_core_podf] = imx_clk_divider("gpu3d_core_podf", "gpu3d_core_sel", base + 0x18, 26, 3); | ||
284 | clk[gpu3d_shader] = imx_clk_divider("gpu3d_shader", "gpu3d_shader_sel", base + 0x18, 29, 3); | ||
285 | clk[ipu1_podf] = imx_clk_divider("ipu1_podf", "ipu1_sel", base + 0x3c, 11, 3); | ||
286 | clk[ipu2_podf] = imx_clk_divider("ipu2_podf", "ipu2_sel", base + 0x3c, 16, 3); | ||
287 | clk[ldb_di0_podf] = imx_clk_divider("ldb_di0_podf", "ldb_di0_sel", base + 0x20, 10, 1); | ||
288 | clk[ldb_di1_podf] = imx_clk_divider("ldb_di1_podf", "ldb_di1_sel", base + 0x20, 11, 1); | ||
289 | clk[ipu1_di0_pre] = imx_clk_divider("ipu1_di0_pre", "ipu1_di0_pre_sel", base + 0x34, 3, 3); | ||
290 | clk[ipu1_di1_pre] = imx_clk_divider("ipu1_di1_pre", "ipu1_di1_pre_sel", base + 0x34, 12, 3); | ||
291 | clk[ipu2_di0_pre] = imx_clk_divider("ipu2_di0_pre", "ipu2_di0_pre_sel", base + 0x38, 3, 3); | ||
292 | clk[ipu2_di1_pre] = imx_clk_divider("ipu2_di1_pre", "ipu2_di1_pre_sel", base + 0x38, 12, 3); | ||
293 | clk[hsi_tx_podf] = imx_clk_divider("hsi_tx_podf", "hsi_tx_sel", base + 0x30, 29, 3); | ||
294 | clk[ssi1_pred] = imx_clk_divider("ssi1_pred", "ssi1_sel", base + 0x28, 6, 3); | ||
295 | clk[ssi1_podf] = imx_clk_divider("ssi1_podf", "ssi1_pred", base + 0x28, 0, 6); | ||
296 | clk[ssi2_pred] = imx_clk_divider("ssi2_pred", "ssi2_sel", base + 0x2c, 6, 3); | ||
297 | clk[ssi2_podf] = imx_clk_divider("ssi2_podf", "ssi2_pred", base + 0x2c, 0, 6); | ||
298 | clk[ssi3_pred] = imx_clk_divider("ssi3_pred", "ssi3_sel", base + 0x28, 22, 3); | ||
299 | clk[ssi3_podf] = imx_clk_divider("ssi3_podf", "ssi3_pred", base + 0x28, 16, 6); | ||
300 | clk[uart_serial_podf] = imx_clk_divider("uart_serial_podf", "pll3_80m", base + 0x24, 0, 6); | ||
301 | clk[usdhc1_podf] = imx_clk_divider("usdhc1_podf", "usdhc1_sel", base + 0x24, 11, 3); | ||
302 | clk[usdhc2_podf] = imx_clk_divider("usdhc2_podf", "usdhc2_sel", base + 0x24, 16, 3); | ||
303 | clk[usdhc3_podf] = imx_clk_divider("usdhc3_podf", "usdhc3_sel", base + 0x24, 19, 3); | ||
304 | clk[usdhc4_podf] = imx_clk_divider("usdhc4_podf", "usdhc4_sel", base + 0x24, 22, 3); | ||
305 | clk[enfc_pred] = imx_clk_divider("enfc_pred", "enfc_sel", base + 0x2c, 18, 3); | ||
306 | clk[enfc_podf] = imx_clk_divider("enfc_podf", "enfc_pred", base + 0x2c, 21, 6); | ||
307 | clk[emi_podf] = imx_clk_divider("emi_podf", "emi_sel", base + 0x1c, 20, 3); | ||
308 | clk[emi_slow_podf] = imx_clk_divider("emi_slow_podf", "emi_slow_sel", base + 0x1c, 23, 3); | ||
309 | clk[vpu_axi_podf] = imx_clk_divider("vpu_axi_podf", "vpu_axi_sel", base + 0x24, 25, 3); | ||
310 | clk[cko1_podf] = imx_clk_divider("cko1_podf", "cko1_sel", base + 0x60, 4, 3); | ||
311 | |||
312 | /* name parent_name reg shift width busy: reg, shift */ | ||
313 | clk[axi] = imx_clk_busy_divider("axi", "axi_sel", base + 0x14, 16, 3, base + 0x48, 0); | ||
314 | clk[mmdc_ch0_axi_podf] = imx_clk_busy_divider("mmdc_ch0_axi_podf", "periph", base + 0x14, 19, 3, base + 0x48, 4); | ||
315 | clk[mmdc_ch1_axi_podf] = imx_clk_busy_divider("mmdc_ch1_axi_podf", "periph2", base + 0x14, 3, 3, base + 0x48, 2); | ||
316 | clk[arm] = imx_clk_busy_divider("arm", "pll1_sw", base + 0x10, 0, 3, base + 0x48, 16); | ||
317 | clk[ahb] = imx_clk_busy_divider("ahb", "periph", base + 0x14, 10, 3, base + 0x48, 1); | ||
318 | |||
319 | /* name parent_name reg shift */ | ||
320 | clk[apbh_dma] = imx_clk_gate2("apbh_dma", "ahb", base + 0x68, 4); | ||
321 | clk[asrc] = imx_clk_gate2("asrc", "asrc_podf", base + 0x68, 6); | ||
322 | clk[can1_ipg] = imx_clk_gate2("can1_ipg", "ipg", base + 0x68, 14); | ||
323 | clk[can1_serial] = imx_clk_gate2("can1_serial", "can_root", base + 0x68, 16); | ||
324 | clk[can2_ipg] = imx_clk_gate2("can2_ipg", "ipg", base + 0x68, 18); | ||
325 | clk[can2_serial] = imx_clk_gate2("can2_serial", "can_root", base + 0x68, 20); | ||
326 | clk[ecspi1] = imx_clk_gate2("ecspi1", "ecspi_root", base + 0x6c, 0); | ||
327 | clk[ecspi2] = imx_clk_gate2("ecspi2", "ecspi_root", base + 0x6c, 2); | ||
328 | clk[ecspi3] = imx_clk_gate2("ecspi3", "ecspi_root", base + 0x6c, 4); | ||
329 | clk[ecspi4] = imx_clk_gate2("ecspi4", "ecspi_root", base + 0x6c, 6); | ||
330 | clk[ecspi5] = imx_clk_gate2("ecspi5", "ecspi_root", base + 0x6c, 8); | ||
331 | clk[enet] = imx_clk_gate2("enet", "ipg", base + 0x6c, 10); | ||
332 | clk[esai] = imx_clk_gate2("esai", "esai_podf", base + 0x6c, 16); | ||
333 | clk[gpt_ipg] = imx_clk_gate2("gpt_ipg", "ipg", base + 0x6c, 20); | ||
334 | clk[gpt_ipg_per] = imx_clk_gate2("gpt_ipg_per", "ipg_per", base + 0x6c, 22); | ||
335 | clk[gpu2d_core] = imx_clk_gate2("gpu2d_core", "gpu2d_core_podf", base + 0x6c, 24); | ||
336 | clk[gpu3d_core] = imx_clk_gate2("gpu3d_core", "gpu3d_core_podf", base + 0x6c, 26); | ||
337 | clk[hdmi_iahb] = imx_clk_gate2("hdmi_iahb", "ahb", base + 0x70, 0); | ||
338 | clk[hdmi_isfr] = imx_clk_gate2("hdmi_isfr", "pll3_pfd1_540m", base + 0x70, 4); | ||
339 | clk[i2c1] = imx_clk_gate2("i2c1", "ipg_per", base + 0x70, 6); | ||
340 | clk[i2c2] = imx_clk_gate2("i2c2", "ipg_per", base + 0x70, 8); | ||
341 | clk[i2c3] = imx_clk_gate2("i2c3", "ipg_per", base + 0x70, 10); | ||
342 | clk[iim] = imx_clk_gate2("iim", "ipg", base + 0x70, 12); | ||
343 | clk[enfc] = imx_clk_gate2("enfc", "enfc_podf", base + 0x70, 14); | ||
344 | clk[ipu1] = imx_clk_gate2("ipu1", "ipu1_podf", base + 0x74, 0); | ||
345 | clk[ipu1_di0] = imx_clk_gate2("ipu1_di0", "ipu1_di0_sel", base + 0x74, 2); | ||
346 | clk[ipu1_di1] = imx_clk_gate2("ipu1_di1", "ipu1_di1_sel", base + 0x74, 4); | ||
347 | clk[ipu2] = imx_clk_gate2("ipu2", "ipu2_podf", base + 0x74, 6); | ||
348 | clk[ipu2_di0] = imx_clk_gate2("ipu2_di0", "ipu2_di0_sel", base + 0x74, 8); | ||
349 | clk[ldb_di0] = imx_clk_gate2("ldb_di0", "ldb_di0_podf", base + 0x74, 12); | ||
350 | clk[ldb_di1] = imx_clk_gate2("ldb_di1", "ldb_di1_podf", base + 0x74, 14); | ||
351 | clk[ipu2_di1] = imx_clk_gate2("ipu2_di1", "ipu2_di1_sel", base + 0x74, 10); | ||
352 | clk[hsi_tx] = imx_clk_gate2("hsi_tx", "hsi_tx_podf", base + 0x74, 16); | ||
353 | clk[mlb] = imx_clk_gate2("mlb", "pll6_mlb", base + 0x74, 18); | ||
354 | clk[mmdc_ch0_axi] = imx_clk_gate2("mmdc_ch0_axi", "mmdc_ch0_axi_podf", base + 0x74, 20); | ||
355 | clk[mmdc_ch1_axi] = imx_clk_gate2("mmdc_ch1_axi", "mmdc_ch1_axi_podf", base + 0x74, 22); | ||
356 | clk[ocram] = imx_clk_gate2("ocram", "ahb", base + 0x74, 28); | ||
357 | clk[openvg_axi] = imx_clk_gate2("openvg_axi", "axi", base + 0x74, 30); | ||
358 | clk[pcie_axi] = imx_clk_gate2("pcie_axi", "pcie_axi_sel", base + 0x78, 0); | ||
359 | clk[pwm1] = imx_clk_gate2("pwm1", "ipg_per", base + 0x78, 16); | ||
360 | clk[pwm2] = imx_clk_gate2("pwm2", "ipg_per", base + 0x78, 18); | ||
361 | clk[pwm3] = imx_clk_gate2("pwm3", "ipg_per", base + 0x78, 20); | ||
362 | clk[pwm4] = imx_clk_gate2("pwm4", "ipg_per", base + 0x78, 22); | ||
363 | clk[gpmi_bch_apb] = imx_clk_gate2("gpmi_bch_apb", "usdhc3", base + 0x78, 24); | ||
364 | clk[gpmi_bch] = imx_clk_gate2("gpmi_bch", "usdhc4", base + 0x78, 26); | ||
365 | clk[gpmi_io] = imx_clk_gate2("gpmi_io", "enfc", base + 0x78, 28); | ||
366 | clk[gpmi_apb] = imx_clk_gate2("gpmi_apb", "usdhc3", base + 0x78, 30); | ||
367 | clk[sata] = imx_clk_gate2("sata", "ipg", base + 0x7c, 4); | ||
368 | clk[sdma] = imx_clk_gate2("sdma", "ahb", base + 0x7c, 6); | ||
369 | clk[spba] = imx_clk_gate2("spba", "ipg", base + 0x7c, 12); | ||
370 | clk[ssi1] = imx_clk_gate2("ssi1", "ssi1_podf", base + 0x7c, 18); | ||
371 | clk[ssi2] = imx_clk_gate2("ssi2", "ssi2_podf", base + 0x7c, 20); | ||
372 | clk[ssi3] = imx_clk_gate2("ssi3", "ssi3_podf", base + 0x7c, 22); | ||
373 | clk[uart_ipg] = imx_clk_gate2("uart_ipg", "ipg", base + 0x7c, 24); | ||
374 | clk[uart_serial] = imx_clk_gate2("uart_serial", "uart_serial_podf", base + 0x7c, 26); | ||
375 | clk[usboh3] = imx_clk_gate2("usboh3", "ipg", base + 0x80, 0); | ||
376 | clk[usdhc1] = imx_clk_gate2("usdhc1", "usdhc1_podf", base + 0x80, 2); | ||
377 | clk[usdhc2] = imx_clk_gate2("usdhc2", "usdhc2_podf", base + 0x80, 4); | ||
378 | clk[usdhc3] = imx_clk_gate2("usdhc3", "usdhc3_podf", base + 0x80, 6); | ||
379 | clk[usdhc4] = imx_clk_gate2("usdhc4", "usdhc4_podf", base + 0x80, 8); | ||
380 | clk[vdo_axi] = imx_clk_gate2("vdo_axi", "vdo_axi_sel", base + 0x80, 12); | ||
381 | clk[vpu_axi] = imx_clk_gate2("vpu_axi", "vpu_axi_podf", base + 0x80, 14); | ||
382 | clk[cko1] = imx_clk_gate("cko1", "cko1_podf", base + 0x60, 7); | ||
383 | |||
384 | for (i = 0; i < ARRAY_SIZE(clk); i++) | ||
385 | if (IS_ERR(clk[i])) | ||
386 | pr_err("i.MX6q clk %d: register failed with %ld\n", | ||
387 | i, PTR_ERR(clk[i])); | ||
388 | |||
389 | clk_register_clkdev(clk[mmdc_ch0_axi], NULL, "mmdc_ch0_axi"); | ||
390 | clk_register_clkdev(clk[mmdc_ch1_axi], NULL, "mmdc_ch1_axi"); | ||
391 | clk_register_clkdev(clk[gpt_ipg], "ipg", "imx-gpt.0"); | ||
392 | clk_register_clkdev(clk[gpt_ipg_per], "per", "imx-gpt.0"); | ||
393 | clk_register_clkdev(clk[twd], NULL, "smp_twd"); | ||
394 | clk_register_clkdev(clk[usboh3], NULL, "usboh3"); | ||
395 | clk_register_clkdev(clk[uart_serial], "per", "2020000.uart"); | ||
396 | clk_register_clkdev(clk[uart_ipg], "ipg", "2020000.uart"); | ||
397 | clk_register_clkdev(clk[uart_serial], "per", "21e8000.uart"); | ||
398 | clk_register_clkdev(clk[uart_ipg], "ipg", "21e8000.uart"); | ||
399 | clk_register_clkdev(clk[uart_serial], "per", "21ec000.uart"); | ||
400 | clk_register_clkdev(clk[uart_ipg], "ipg", "21ec000.uart"); | ||
401 | clk_register_clkdev(clk[uart_serial], "per", "21f0000.uart"); | ||
402 | clk_register_clkdev(clk[uart_ipg], "ipg", "21f0000.uart"); | ||
403 | clk_register_clkdev(clk[uart_serial], "per", "21f4000.uart"); | ||
404 | clk_register_clkdev(clk[uart_ipg], "ipg", "21f4000.uart"); | ||
405 | clk_register_clkdev(clk[enet], NULL, "2188000.enet"); | ||
406 | clk_register_clkdev(clk[usdhc1], NULL, "2190000.usdhc"); | ||
407 | clk_register_clkdev(clk[usdhc2], NULL, "2194000.usdhc"); | ||
408 | clk_register_clkdev(clk[usdhc3], NULL, "2198000.usdhc"); | ||
409 | clk_register_clkdev(clk[usdhc4], NULL, "219c000.usdhc"); | ||
410 | clk_register_clkdev(clk[i2c1], NULL, "21a0000.i2c"); | ||
411 | clk_register_clkdev(clk[i2c2], NULL, "21a4000.i2c"); | ||
412 | clk_register_clkdev(clk[i2c3], NULL, "21a8000.i2c"); | ||
413 | clk_register_clkdev(clk[ecspi1], NULL, "2008000.ecspi"); | ||
414 | clk_register_clkdev(clk[ecspi2], NULL, "200c000.ecspi"); | ||
415 | clk_register_clkdev(clk[ecspi3], NULL, "2010000.ecspi"); | ||
416 | clk_register_clkdev(clk[ecspi4], NULL, "2014000.ecspi"); | ||
417 | clk_register_clkdev(clk[ecspi5], NULL, "2018000.ecspi"); | ||
418 | clk_register_clkdev(clk[sdma], NULL, "20ec000.sdma"); | ||
419 | clk_register_clkdev(clk[dummy], NULL, "20bc000.wdog"); | ||
420 | clk_register_clkdev(clk[dummy], NULL, "20c0000.wdog"); | ||
421 | |||
422 | for (i = 0; i < ARRAY_SIZE(clks_init_on); i++) { | ||
423 | c = clk_get_sys(clks_init_on[i], NULL); | ||
424 | if (IS_ERR(c)) { | ||
425 | pr_err("%s: failed to get clk %s", __func__, | ||
426 | clks_init_on[i]); | ||
427 | return PTR_ERR(c); | ||
428 | } | ||
429 | clk_prepare_enable(c); | ||
430 | } | ||
431 | |||
432 | np = of_find_compatible_node(NULL, NULL, "fsl,imx6q-gpt"); | ||
433 | base = of_iomap(np, 0); | ||
434 | WARN_ON(!base); | ||
435 | irq = irq_of_parse_and_map(np, 0); | ||
436 | mxc_timer_init(NULL, base, irq); | ||
437 | |||
438 | return 0; | ||
439 | } | ||
diff --git a/arch/arm/mach-imx/clk-pfd.c b/arch/arm/mach-imx/clk-pfd.c new file mode 100644 index 000000000000..e2ed4160f329 --- /dev/null +++ b/arch/arm/mach-imx/clk-pfd.c | |||
@@ -0,0 +1,147 @@ | |||
1 | /* | ||
2 | * Copyright 2012 Freescale Semiconductor, Inc. | ||
3 | * Copyright 2012 Linaro Ltd. | ||
4 | * | ||
5 | * The code contained herein is licensed under the GNU General Public | ||
6 | * License. You may obtain a copy of the GNU General Public License | ||
7 | * Version 2 or later at the following locations: | ||
8 | * | ||
9 | * http://www.opensource.org/licenses/gpl-license.html | ||
10 | * http://www.gnu.org/copyleft/gpl.html | ||
11 | */ | ||
12 | |||
13 | #include <linux/clk.h> | ||
14 | #include <linux/clk-provider.h> | ||
15 | #include <linux/io.h> | ||
16 | #include <linux/slab.h> | ||
17 | #include <linux/err.h> | ||
18 | #include "clk.h" | ||
19 | |||
20 | /** | ||
21 | * struct clk_pfd - IMX PFD clock | ||
22 | * @clk_hw: clock source | ||
23 | * @reg: PFD register address | ||
24 | * @idx: the index of PFD encoded in the register | ||
25 | * | ||
26 | * PFD clock found on i.MX6 series. Each register for PFD has 4 clk_pfd | ||
27 | * data encoded, and member idx is used to specify the one. And each | ||
28 | * register has SET, CLR and TOG registers at offset 0x4 0x8 and 0xc. | ||
29 | */ | ||
30 | struct clk_pfd { | ||
31 | struct clk_hw hw; | ||
32 | void __iomem *reg; | ||
33 | u8 idx; | ||
34 | }; | ||
35 | |||
36 | #define to_clk_pfd(_hw) container_of(_hw, struct clk_pfd, hw) | ||
37 | |||
38 | #define SET 0x4 | ||
39 | #define CLR 0x8 | ||
40 | #define OTG 0xc | ||
41 | |||
42 | static int clk_pfd_enable(struct clk_hw *hw) | ||
43 | { | ||
44 | struct clk_pfd *pfd = to_clk_pfd(hw); | ||
45 | |||
46 | writel_relaxed(1 << ((pfd->idx + 1) * 8 - 1), pfd->reg + CLR); | ||
47 | |||
48 | return 0; | ||
49 | } | ||
50 | |||
51 | static void clk_pfd_disable(struct clk_hw *hw) | ||
52 | { | ||
53 | struct clk_pfd *pfd = to_clk_pfd(hw); | ||
54 | |||
55 | writel_relaxed(1 << ((pfd->idx + 1) * 8 - 1), pfd->reg + SET); | ||
56 | } | ||
57 | |||
58 | static unsigned long clk_pfd_recalc_rate(struct clk_hw *hw, | ||
59 | unsigned long parent_rate) | ||
60 | { | ||
61 | struct clk_pfd *pfd = to_clk_pfd(hw); | ||
62 | u64 tmp = parent_rate; | ||
63 | u8 frac = (readl_relaxed(pfd->reg) >> (pfd->idx * 8)) & 0x3f; | ||
64 | |||
65 | tmp *= 18; | ||
66 | do_div(tmp, frac); | ||
67 | |||
68 | return tmp; | ||
69 | } | ||
70 | |||
71 | static long clk_pfd_round_rate(struct clk_hw *hw, unsigned long rate, | ||
72 | unsigned long *prate) | ||
73 | { | ||
74 | u64 tmp = *prate; | ||
75 | u8 frac; | ||
76 | |||
77 | tmp = tmp * 18 + rate / 2; | ||
78 | do_div(tmp, rate); | ||
79 | frac = tmp; | ||
80 | if (frac < 12) | ||
81 | frac = 12; | ||
82 | else if (frac > 35) | ||
83 | frac = 35; | ||
84 | tmp = *prate; | ||
85 | tmp *= 18; | ||
86 | do_div(tmp, frac); | ||
87 | |||
88 | return tmp; | ||
89 | } | ||
90 | |||
91 | static int clk_pfd_set_rate(struct clk_hw *hw, unsigned long rate, | ||
92 | unsigned long parent_rate) | ||
93 | { | ||
94 | struct clk_pfd *pfd = to_clk_pfd(hw); | ||
95 | u64 tmp = parent_rate; | ||
96 | u8 frac; | ||
97 | |||
98 | tmp = tmp * 18 + rate / 2; | ||
99 | do_div(tmp, rate); | ||
100 | frac = tmp; | ||
101 | if (frac < 12) | ||
102 | frac = 12; | ||
103 | else if (frac > 35) | ||
104 | frac = 35; | ||
105 | |||
106 | writel_relaxed(0x3f << (pfd->idx * 8), pfd->reg + CLR); | ||
107 | writel_relaxed(frac << (pfd->idx * 8), pfd->reg + SET); | ||
108 | |||
109 | return 0; | ||
110 | } | ||
111 | |||
112 | static const struct clk_ops clk_pfd_ops = { | ||
113 | .enable = clk_pfd_enable, | ||
114 | .disable = clk_pfd_disable, | ||
115 | .recalc_rate = clk_pfd_recalc_rate, | ||
116 | .round_rate = clk_pfd_round_rate, | ||
117 | .set_rate = clk_pfd_set_rate, | ||
118 | }; | ||
119 | |||
120 | struct clk *imx_clk_pfd(const char *name, const char *parent_name, | ||
121 | void __iomem *reg, u8 idx) | ||
122 | { | ||
123 | struct clk_pfd *pfd; | ||
124 | struct clk *clk; | ||
125 | struct clk_init_data init; | ||
126 | |||
127 | pfd = kzalloc(sizeof(*pfd), GFP_KERNEL); | ||
128 | if (!pfd) | ||
129 | return ERR_PTR(-ENOMEM); | ||
130 | |||
131 | pfd->reg = reg; | ||
132 | pfd->idx = idx; | ||
133 | |||
134 | init.name = name; | ||
135 | init.ops = &clk_pfd_ops; | ||
136 | init.flags = 0; | ||
137 | init.parent_names = &parent_name; | ||
138 | init.num_parents = 1; | ||
139 | |||
140 | pfd->hw.init = &init; | ||
141 | |||
142 | clk = clk_register(NULL, &pfd->hw); | ||
143 | if (IS_ERR(clk)) | ||
144 | kfree(pfd); | ||
145 | |||
146 | return clk; | ||
147 | } | ||
diff --git a/arch/arm/mach-imx/clk-pllv1.c b/arch/arm/mach-imx/clk-pllv1.c new file mode 100644 index 000000000000..2d856f9ccf59 --- /dev/null +++ b/arch/arm/mach-imx/clk-pllv1.c | |||
@@ -0,0 +1,66 @@ | |||
1 | #include <linux/clk.h> | ||
2 | #include <linux/clk-provider.h> | ||
3 | #include <linux/io.h> | ||
4 | #include <linux/slab.h> | ||
5 | #include <linux/kernel.h> | ||
6 | #include <linux/err.h> | ||
7 | #include <mach/common.h> | ||
8 | #include <mach/hardware.h> | ||
9 | #include <mach/clock.h> | ||
10 | #include "clk.h" | ||
11 | |||
12 | /** | ||
13 | * pll v1 | ||
14 | * | ||
15 | * @clk_hw clock source | ||
16 | * @parent the parent clock name | ||
17 | * @base base address of pll registers | ||
18 | * | ||
19 | * PLL clock version 1, found on i.MX1/21/25/27/31/35 | ||
20 | */ | ||
21 | struct clk_pllv1 { | ||
22 | struct clk_hw hw; | ||
23 | void __iomem *base; | ||
24 | }; | ||
25 | |||
26 | #define to_clk_pllv1(clk) (container_of(clk, struct clk_pllv1, clk)) | ||
27 | |||
28 | static unsigned long clk_pllv1_recalc_rate(struct clk_hw *hw, | ||
29 | unsigned long parent_rate) | ||
30 | { | ||
31 | struct clk_pllv1 *pll = to_clk_pllv1(hw); | ||
32 | |||
33 | return mxc_decode_pll(readl(pll->base), parent_rate); | ||
34 | } | ||
35 | |||
36 | struct clk_ops clk_pllv1_ops = { | ||
37 | .recalc_rate = clk_pllv1_recalc_rate, | ||
38 | }; | ||
39 | |||
40 | struct clk *imx_clk_pllv1(const char *name, const char *parent, | ||
41 | void __iomem *base) | ||
42 | { | ||
43 | struct clk_pllv1 *pll; | ||
44 | struct clk *clk; | ||
45 | struct clk_init_data init; | ||
46 | |||
47 | pll = kmalloc(sizeof(*pll), GFP_KERNEL); | ||
48 | if (!pll) | ||
49 | return ERR_PTR(-ENOMEM); | ||
50 | |||
51 | pll->base = base; | ||
52 | |||
53 | init.name = name; | ||
54 | init.ops = &clk_pllv1_ops; | ||
55 | init.flags = 0; | ||
56 | init.parent_names = &parent; | ||
57 | init.num_parents = 1; | ||
58 | |||
59 | pll->hw.init = &init; | ||
60 | |||
61 | clk = clk_register(NULL, &pll->hw); | ||
62 | if (IS_ERR(clk)) | ||
63 | kfree(pll); | ||
64 | |||
65 | return clk; | ||
66 | } | ||
diff --git a/arch/arm/mach-imx/clk-pllv2.c b/arch/arm/mach-imx/clk-pllv2.c new file mode 100644 index 000000000000..4685919deb63 --- /dev/null +++ b/arch/arm/mach-imx/clk-pllv2.c | |||
@@ -0,0 +1,249 @@ | |||
1 | #include <linux/kernel.h> | ||
2 | #include <linux/clk.h> | ||
3 | #include <linux/io.h> | ||
4 | #include <linux/errno.h> | ||
5 | #include <linux/delay.h> | ||
6 | #include <linux/slab.h> | ||
7 | #include <linux/err.h> | ||
8 | |||
9 | #include <asm/div64.h> | ||
10 | |||
11 | #include "clk.h" | ||
12 | |||
13 | #define to_clk_pllv2(clk) (container_of(clk, struct clk_pllv2, clk)) | ||
14 | |||
15 | /* PLL Register Offsets */ | ||
16 | #define MXC_PLL_DP_CTL 0x00 | ||
17 | #define MXC_PLL_DP_CONFIG 0x04 | ||
18 | #define MXC_PLL_DP_OP 0x08 | ||
19 | #define MXC_PLL_DP_MFD 0x0C | ||
20 | #define MXC_PLL_DP_MFN 0x10 | ||
21 | #define MXC_PLL_DP_MFNMINUS 0x14 | ||
22 | #define MXC_PLL_DP_MFNPLUS 0x18 | ||
23 | #define MXC_PLL_DP_HFS_OP 0x1C | ||
24 | #define MXC_PLL_DP_HFS_MFD 0x20 | ||
25 | #define MXC_PLL_DP_HFS_MFN 0x24 | ||
26 | #define MXC_PLL_DP_MFN_TOGC 0x28 | ||
27 | #define MXC_PLL_DP_DESTAT 0x2c | ||
28 | |||
29 | /* PLL Register Bit definitions */ | ||
30 | #define MXC_PLL_DP_CTL_MUL_CTRL 0x2000 | ||
31 | #define MXC_PLL_DP_CTL_DPDCK0_2_EN 0x1000 | ||
32 | #define MXC_PLL_DP_CTL_DPDCK0_2_OFFSET 12 | ||
33 | #define MXC_PLL_DP_CTL_ADE 0x800 | ||
34 | #define MXC_PLL_DP_CTL_REF_CLK_DIV 0x400 | ||
35 | #define MXC_PLL_DP_CTL_REF_CLK_SEL_MASK (3 << 8) | ||
36 | #define MXC_PLL_DP_CTL_REF_CLK_SEL_OFFSET 8 | ||
37 | #define MXC_PLL_DP_CTL_HFSM 0x80 | ||
38 | #define MXC_PLL_DP_CTL_PRE 0x40 | ||
39 | #define MXC_PLL_DP_CTL_UPEN 0x20 | ||
40 | #define MXC_PLL_DP_CTL_RST 0x10 | ||
41 | #define MXC_PLL_DP_CTL_RCP 0x8 | ||
42 | #define MXC_PLL_DP_CTL_PLM 0x4 | ||
43 | #define MXC_PLL_DP_CTL_BRM0 0x2 | ||
44 | #define MXC_PLL_DP_CTL_LRF 0x1 | ||
45 | |||
46 | #define MXC_PLL_DP_CONFIG_BIST 0x8 | ||
47 | #define MXC_PLL_DP_CONFIG_SJC_CE 0x4 | ||
48 | #define MXC_PLL_DP_CONFIG_AREN 0x2 | ||
49 | #define MXC_PLL_DP_CONFIG_LDREQ 0x1 | ||
50 | |||
51 | #define MXC_PLL_DP_OP_MFI_OFFSET 4 | ||
52 | #define MXC_PLL_DP_OP_MFI_MASK (0xF << 4) | ||
53 | #define MXC_PLL_DP_OP_PDF_OFFSET 0 | ||
54 | #define MXC_PLL_DP_OP_PDF_MASK 0xF | ||
55 | |||
56 | #define MXC_PLL_DP_MFD_OFFSET 0 | ||
57 | #define MXC_PLL_DP_MFD_MASK 0x07FFFFFF | ||
58 | |||
59 | #define MXC_PLL_DP_MFN_OFFSET 0x0 | ||
60 | #define MXC_PLL_DP_MFN_MASK 0x07FFFFFF | ||
61 | |||
62 | #define MXC_PLL_DP_MFN_TOGC_TOG_DIS (1 << 17) | ||
63 | #define MXC_PLL_DP_MFN_TOGC_TOG_EN (1 << 16) | ||
64 | #define MXC_PLL_DP_MFN_TOGC_CNT_OFFSET 0x0 | ||
65 | #define MXC_PLL_DP_MFN_TOGC_CNT_MASK 0xFFFF | ||
66 | |||
67 | #define MXC_PLL_DP_DESTAT_TOG_SEL (1 << 31) | ||
68 | #define MXC_PLL_DP_DESTAT_MFN 0x07FFFFFF | ||
69 | |||
70 | #define MAX_DPLL_WAIT_TRIES 1000 /* 1000 * udelay(1) = 1ms */ | ||
71 | |||
72 | struct clk_pllv2 { | ||
73 | struct clk_hw hw; | ||
74 | void __iomem *base; | ||
75 | }; | ||
76 | |||
77 | static unsigned long clk_pllv2_recalc_rate(struct clk_hw *hw, | ||
78 | unsigned long parent_rate) | ||
79 | { | ||
80 | long mfi, mfn, mfd, pdf, ref_clk, mfn_abs; | ||
81 | unsigned long dp_op, dp_mfd, dp_mfn, dp_ctl, pll_hfsm, dbl; | ||
82 | void __iomem *pllbase; | ||
83 | s64 temp; | ||
84 | struct clk_pllv2 *pll = to_clk_pllv2(hw); | ||
85 | |||
86 | pllbase = pll->base; | ||
87 | |||
88 | dp_ctl = __raw_readl(pllbase + MXC_PLL_DP_CTL); | ||
89 | pll_hfsm = dp_ctl & MXC_PLL_DP_CTL_HFSM; | ||
90 | dbl = dp_ctl & MXC_PLL_DP_CTL_DPDCK0_2_EN; | ||
91 | |||
92 | if (pll_hfsm == 0) { | ||
93 | dp_op = __raw_readl(pllbase + MXC_PLL_DP_OP); | ||
94 | dp_mfd = __raw_readl(pllbase + MXC_PLL_DP_MFD); | ||
95 | dp_mfn = __raw_readl(pllbase + MXC_PLL_DP_MFN); | ||
96 | } else { | ||
97 | dp_op = __raw_readl(pllbase + MXC_PLL_DP_HFS_OP); | ||
98 | dp_mfd = __raw_readl(pllbase + MXC_PLL_DP_HFS_MFD); | ||
99 | dp_mfn = __raw_readl(pllbase + MXC_PLL_DP_HFS_MFN); | ||
100 | } | ||
101 | pdf = dp_op & MXC_PLL_DP_OP_PDF_MASK; | ||
102 | mfi = (dp_op & MXC_PLL_DP_OP_MFI_MASK) >> MXC_PLL_DP_OP_MFI_OFFSET; | ||
103 | mfi = (mfi <= 5) ? 5 : mfi; | ||
104 | mfd = dp_mfd & MXC_PLL_DP_MFD_MASK; | ||
105 | mfn = mfn_abs = dp_mfn & MXC_PLL_DP_MFN_MASK; | ||
106 | /* Sign extend to 32-bits */ | ||
107 | if (mfn >= 0x04000000) { | ||
108 | mfn |= 0xFC000000; | ||
109 | mfn_abs = -mfn; | ||
110 | } | ||
111 | |||
112 | ref_clk = 2 * parent_rate; | ||
113 | if (dbl != 0) | ||
114 | ref_clk *= 2; | ||
115 | |||
116 | ref_clk /= (pdf + 1); | ||
117 | temp = (u64) ref_clk * mfn_abs; | ||
118 | do_div(temp, mfd + 1); | ||
119 | if (mfn < 0) | ||
120 | temp = -temp; | ||
121 | temp = (ref_clk * mfi) + temp; | ||
122 | |||
123 | return temp; | ||
124 | } | ||
125 | |||
126 | static int clk_pllv2_set_rate(struct clk_hw *hw, unsigned long rate, | ||
127 | unsigned long parent_rate) | ||
128 | { | ||
129 | struct clk_pllv2 *pll = to_clk_pllv2(hw); | ||
130 | u32 reg; | ||
131 | void __iomem *pllbase; | ||
132 | long mfi, pdf, mfn, mfd = 999999; | ||
133 | s64 temp64; | ||
134 | unsigned long quad_parent_rate; | ||
135 | unsigned long pll_hfsm, dp_ctl; | ||
136 | |||
137 | pllbase = pll->base; | ||
138 | |||
139 | quad_parent_rate = 4 * parent_rate; | ||
140 | pdf = mfi = -1; | ||
141 | while (++pdf < 16 && mfi < 5) | ||
142 | mfi = rate * (pdf+1) / quad_parent_rate; | ||
143 | if (mfi > 15) | ||
144 | return -EINVAL; | ||
145 | pdf--; | ||
146 | |||
147 | temp64 = rate * (pdf+1) - quad_parent_rate * mfi; | ||
148 | do_div(temp64, quad_parent_rate/1000000); | ||
149 | mfn = (long)temp64; | ||
150 | |||
151 | dp_ctl = __raw_readl(pllbase + MXC_PLL_DP_CTL); | ||
152 | /* use dpdck0_2 */ | ||
153 | __raw_writel(dp_ctl | 0x1000L, pllbase + MXC_PLL_DP_CTL); | ||
154 | pll_hfsm = dp_ctl & MXC_PLL_DP_CTL_HFSM; | ||
155 | if (pll_hfsm == 0) { | ||
156 | reg = mfi << 4 | pdf; | ||
157 | __raw_writel(reg, pllbase + MXC_PLL_DP_OP); | ||
158 | __raw_writel(mfd, pllbase + MXC_PLL_DP_MFD); | ||
159 | __raw_writel(mfn, pllbase + MXC_PLL_DP_MFN); | ||
160 | } else { | ||
161 | reg = mfi << 4 | pdf; | ||
162 | __raw_writel(reg, pllbase + MXC_PLL_DP_HFS_OP); | ||
163 | __raw_writel(mfd, pllbase + MXC_PLL_DP_HFS_MFD); | ||
164 | __raw_writel(mfn, pllbase + MXC_PLL_DP_HFS_MFN); | ||
165 | } | ||
166 | |||
167 | return 0; | ||
168 | } | ||
169 | |||
170 | static long clk_pllv2_round_rate(struct clk_hw *hw, unsigned long rate, | ||
171 | unsigned long *prate) | ||
172 | { | ||
173 | return rate; | ||
174 | } | ||
175 | |||
176 | static int clk_pllv2_prepare(struct clk_hw *hw) | ||
177 | { | ||
178 | struct clk_pllv2 *pll = to_clk_pllv2(hw); | ||
179 | u32 reg; | ||
180 | void __iomem *pllbase; | ||
181 | int i = 0; | ||
182 | |||
183 | pllbase = pll->base; | ||
184 | reg = __raw_readl(pllbase + MXC_PLL_DP_CTL) | MXC_PLL_DP_CTL_UPEN; | ||
185 | __raw_writel(reg, pllbase + MXC_PLL_DP_CTL); | ||
186 | |||
187 | /* Wait for lock */ | ||
188 | do { | ||
189 | reg = __raw_readl(pllbase + MXC_PLL_DP_CTL); | ||
190 | if (reg & MXC_PLL_DP_CTL_LRF) | ||
191 | break; | ||
192 | |||
193 | udelay(1); | ||
194 | } while (++i < MAX_DPLL_WAIT_TRIES); | ||
195 | |||
196 | if (i == MAX_DPLL_WAIT_TRIES) { | ||
197 | pr_err("MX5: pll locking failed\n"); | ||
198 | return -EINVAL; | ||
199 | } | ||
200 | |||
201 | return 0; | ||
202 | } | ||
203 | |||
204 | static void clk_pllv2_unprepare(struct clk_hw *hw) | ||
205 | { | ||
206 | struct clk_pllv2 *pll = to_clk_pllv2(hw); | ||
207 | u32 reg; | ||
208 | void __iomem *pllbase; | ||
209 | |||
210 | pllbase = pll->base; | ||
211 | reg = __raw_readl(pllbase + MXC_PLL_DP_CTL) & ~MXC_PLL_DP_CTL_UPEN; | ||
212 | __raw_writel(reg, pllbase + MXC_PLL_DP_CTL); | ||
213 | } | ||
214 | |||
215 | struct clk_ops clk_pllv2_ops = { | ||
216 | .prepare = clk_pllv2_prepare, | ||
217 | .unprepare = clk_pllv2_unprepare, | ||
218 | .recalc_rate = clk_pllv2_recalc_rate, | ||
219 | .round_rate = clk_pllv2_round_rate, | ||
220 | .set_rate = clk_pllv2_set_rate, | ||
221 | }; | ||
222 | |||
223 | struct clk *imx_clk_pllv2(const char *name, const char *parent, | ||
224 | void __iomem *base) | ||
225 | { | ||
226 | struct clk_pllv2 *pll; | ||
227 | struct clk *clk; | ||
228 | struct clk_init_data init; | ||
229 | |||
230 | pll = kzalloc(sizeof(*pll), GFP_KERNEL); | ||
231 | if (!pll) | ||
232 | return ERR_PTR(-ENOMEM); | ||
233 | |||
234 | pll->base = base; | ||
235 | |||
236 | init.name = name; | ||
237 | init.ops = &clk_pllv2_ops; | ||
238 | init.flags = 0; | ||
239 | init.parent_names = &parent; | ||
240 | init.num_parents = 1; | ||
241 | |||
242 | pll->hw.init = &init; | ||
243 | |||
244 | clk = clk_register(NULL, &pll->hw); | ||
245 | if (IS_ERR(clk)) | ||
246 | kfree(pll); | ||
247 | |||
248 | return clk; | ||
249 | } | ||
diff --git a/arch/arm/mach-imx/clk-pllv3.c b/arch/arm/mach-imx/clk-pllv3.c new file mode 100644 index 000000000000..36aac947bce1 --- /dev/null +++ b/arch/arm/mach-imx/clk-pllv3.c | |||
@@ -0,0 +1,419 @@ | |||
1 | /* | ||
2 | * Copyright 2012 Freescale Semiconductor, Inc. | ||
3 | * Copyright 2012 Linaro Ltd. | ||
4 | * | ||
5 | * The code contained herein is licensed under the GNU General Public | ||
6 | * License. You may obtain a copy of the GNU General Public License | ||
7 | * Version 2 or later at the following locations: | ||
8 | * | ||
9 | * http://www.opensource.org/licenses/gpl-license.html | ||
10 | * http://www.gnu.org/copyleft/gpl.html | ||
11 | */ | ||
12 | |||
13 | #include <linux/clk.h> | ||
14 | #include <linux/clk-provider.h> | ||
15 | #include <linux/io.h> | ||
16 | #include <linux/slab.h> | ||
17 | #include <linux/jiffies.h> | ||
18 | #include <linux/err.h> | ||
19 | #include "clk.h" | ||
20 | |||
21 | #define PLL_NUM_OFFSET 0x10 | ||
22 | #define PLL_DENOM_OFFSET 0x20 | ||
23 | |||
24 | #define BM_PLL_POWER (0x1 << 12) | ||
25 | #define BM_PLL_ENABLE (0x1 << 13) | ||
26 | #define BM_PLL_BYPASS (0x1 << 16) | ||
27 | #define BM_PLL_LOCK (0x1 << 31) | ||
28 | |||
29 | /** | ||
30 | * struct clk_pllv3 - IMX PLL clock version 3 | ||
31 | * @clk_hw: clock source | ||
32 | * @base: base address of PLL registers | ||
33 | * @powerup_set: set POWER bit to power up the PLL | ||
34 | * @gate_mask: mask of gate bits | ||
35 | * @div_mask: mask of divider bits | ||
36 | * | ||
37 | * IMX PLL clock version 3, found on i.MX6 series. Divider for pllv3 | ||
38 | * is actually a multiplier, and always sits at bit 0. | ||
39 | */ | ||
40 | struct clk_pllv3 { | ||
41 | struct clk_hw hw; | ||
42 | void __iomem *base; | ||
43 | bool powerup_set; | ||
44 | u32 gate_mask; | ||
45 | u32 div_mask; | ||
46 | }; | ||
47 | |||
48 | #define to_clk_pllv3(_hw) container_of(_hw, struct clk_pllv3, hw) | ||
49 | |||
50 | static int clk_pllv3_prepare(struct clk_hw *hw) | ||
51 | { | ||
52 | struct clk_pllv3 *pll = to_clk_pllv3(hw); | ||
53 | unsigned long timeout = jiffies + msecs_to_jiffies(10); | ||
54 | u32 val; | ||
55 | |||
56 | val = readl_relaxed(pll->base); | ||
57 | val &= ~BM_PLL_BYPASS; | ||
58 | if (pll->powerup_set) | ||
59 | val |= BM_PLL_POWER; | ||
60 | else | ||
61 | val &= ~BM_PLL_POWER; | ||
62 | writel_relaxed(val, pll->base); | ||
63 | |||
64 | /* Wait for PLL to lock */ | ||
65 | while (!(readl_relaxed(pll->base) & BM_PLL_LOCK)) | ||
66 | if (time_after(jiffies, timeout)) | ||
67 | return -ETIMEDOUT; | ||
68 | |||
69 | return 0; | ||
70 | } | ||
71 | |||
72 | static void clk_pllv3_unprepare(struct clk_hw *hw) | ||
73 | { | ||
74 | struct clk_pllv3 *pll = to_clk_pllv3(hw); | ||
75 | u32 val; | ||
76 | |||
77 | val = readl_relaxed(pll->base); | ||
78 | val |= BM_PLL_BYPASS; | ||
79 | if (pll->powerup_set) | ||
80 | val &= ~BM_PLL_POWER; | ||
81 | else | ||
82 | val |= BM_PLL_POWER; | ||
83 | writel_relaxed(val, pll->base); | ||
84 | } | ||
85 | |||
86 | static int clk_pllv3_enable(struct clk_hw *hw) | ||
87 | { | ||
88 | struct clk_pllv3 *pll = to_clk_pllv3(hw); | ||
89 | u32 val; | ||
90 | |||
91 | val = readl_relaxed(pll->base); | ||
92 | val |= pll->gate_mask; | ||
93 | writel_relaxed(val, pll->base); | ||
94 | |||
95 | return 0; | ||
96 | } | ||
97 | |||
98 | static void clk_pllv3_disable(struct clk_hw *hw) | ||
99 | { | ||
100 | struct clk_pllv3 *pll = to_clk_pllv3(hw); | ||
101 | u32 val; | ||
102 | |||
103 | val = readl_relaxed(pll->base); | ||
104 | val &= ~pll->gate_mask; | ||
105 | writel_relaxed(val, pll->base); | ||
106 | } | ||
107 | |||
108 | static unsigned long clk_pllv3_recalc_rate(struct clk_hw *hw, | ||
109 | unsigned long parent_rate) | ||
110 | { | ||
111 | struct clk_pllv3 *pll = to_clk_pllv3(hw); | ||
112 | u32 div = readl_relaxed(pll->base) & pll->div_mask; | ||
113 | |||
114 | return (div == 1) ? parent_rate * 22 : parent_rate * 20; | ||
115 | } | ||
116 | |||
117 | static long clk_pllv3_round_rate(struct clk_hw *hw, unsigned long rate, | ||
118 | unsigned long *prate) | ||
119 | { | ||
120 | unsigned long parent_rate = *prate; | ||
121 | |||
122 | return (rate >= parent_rate * 22) ? parent_rate * 22 : | ||
123 | parent_rate * 20; | ||
124 | } | ||
125 | |||
126 | static int clk_pllv3_set_rate(struct clk_hw *hw, unsigned long rate, | ||
127 | unsigned long parent_rate) | ||
128 | { | ||
129 | struct clk_pllv3 *pll = to_clk_pllv3(hw); | ||
130 | u32 val, div; | ||
131 | |||
132 | if (rate == parent_rate * 22) | ||
133 | div = 1; | ||
134 | else if (rate == parent_rate * 20) | ||
135 | div = 0; | ||
136 | else | ||
137 | return -EINVAL; | ||
138 | |||
139 | val = readl_relaxed(pll->base); | ||
140 | val &= ~pll->div_mask; | ||
141 | val |= div; | ||
142 | writel_relaxed(val, pll->base); | ||
143 | |||
144 | return 0; | ||
145 | } | ||
146 | |||
147 | static const struct clk_ops clk_pllv3_ops = { | ||
148 | .prepare = clk_pllv3_prepare, | ||
149 | .unprepare = clk_pllv3_unprepare, | ||
150 | .enable = clk_pllv3_enable, | ||
151 | .disable = clk_pllv3_disable, | ||
152 | .recalc_rate = clk_pllv3_recalc_rate, | ||
153 | .round_rate = clk_pllv3_round_rate, | ||
154 | .set_rate = clk_pllv3_set_rate, | ||
155 | }; | ||
156 | |||
157 | static unsigned long clk_pllv3_sys_recalc_rate(struct clk_hw *hw, | ||
158 | unsigned long parent_rate) | ||
159 | { | ||
160 | struct clk_pllv3 *pll = to_clk_pllv3(hw); | ||
161 | u32 div = readl_relaxed(pll->base) & pll->div_mask; | ||
162 | |||
163 | return parent_rate * div / 2; | ||
164 | } | ||
165 | |||
166 | static long clk_pllv3_sys_round_rate(struct clk_hw *hw, unsigned long rate, | ||
167 | unsigned long *prate) | ||
168 | { | ||
169 | unsigned long parent_rate = *prate; | ||
170 | unsigned long min_rate = parent_rate * 54 / 2; | ||
171 | unsigned long max_rate = parent_rate * 108 / 2; | ||
172 | u32 div; | ||
173 | |||
174 | if (rate > max_rate) | ||
175 | rate = max_rate; | ||
176 | else if (rate < min_rate) | ||
177 | rate = min_rate; | ||
178 | div = rate * 2 / parent_rate; | ||
179 | |||
180 | return parent_rate * div / 2; | ||
181 | } | ||
182 | |||
183 | static int clk_pllv3_sys_set_rate(struct clk_hw *hw, unsigned long rate, | ||
184 | unsigned long parent_rate) | ||
185 | { | ||
186 | struct clk_pllv3 *pll = to_clk_pllv3(hw); | ||
187 | unsigned long min_rate = parent_rate * 54 / 2; | ||
188 | unsigned long max_rate = parent_rate * 108 / 2; | ||
189 | u32 val, div; | ||
190 | |||
191 | if (rate < min_rate || rate > max_rate) | ||
192 | return -EINVAL; | ||
193 | |||
194 | div = rate * 2 / parent_rate; | ||
195 | val = readl_relaxed(pll->base); | ||
196 | val &= ~pll->div_mask; | ||
197 | val |= div; | ||
198 | writel_relaxed(val, pll->base); | ||
199 | |||
200 | return 0; | ||
201 | } | ||
202 | |||
203 | static const struct clk_ops clk_pllv3_sys_ops = { | ||
204 | .prepare = clk_pllv3_prepare, | ||
205 | .unprepare = clk_pllv3_unprepare, | ||
206 | .enable = clk_pllv3_enable, | ||
207 | .disable = clk_pllv3_disable, | ||
208 | .recalc_rate = clk_pllv3_sys_recalc_rate, | ||
209 | .round_rate = clk_pllv3_sys_round_rate, | ||
210 | .set_rate = clk_pllv3_sys_set_rate, | ||
211 | }; | ||
212 | |||
213 | static unsigned long clk_pllv3_av_recalc_rate(struct clk_hw *hw, | ||
214 | unsigned long parent_rate) | ||
215 | { | ||
216 | struct clk_pllv3 *pll = to_clk_pllv3(hw); | ||
217 | u32 mfn = readl_relaxed(pll->base + PLL_NUM_OFFSET); | ||
218 | u32 mfd = readl_relaxed(pll->base + PLL_DENOM_OFFSET); | ||
219 | u32 div = readl_relaxed(pll->base) & pll->div_mask; | ||
220 | |||
221 | return (parent_rate * div) + ((parent_rate / mfd) * mfn); | ||
222 | } | ||
223 | |||
224 | static long clk_pllv3_av_round_rate(struct clk_hw *hw, unsigned long rate, | ||
225 | unsigned long *prate) | ||
226 | { | ||
227 | unsigned long parent_rate = *prate; | ||
228 | unsigned long min_rate = parent_rate * 27; | ||
229 | unsigned long max_rate = parent_rate * 54; | ||
230 | u32 div; | ||
231 | u32 mfn, mfd = 1000000; | ||
232 | s64 temp64; | ||
233 | |||
234 | if (rate > max_rate) | ||
235 | rate = max_rate; | ||
236 | else if (rate < min_rate) | ||
237 | rate = min_rate; | ||
238 | |||
239 | div = rate / parent_rate; | ||
240 | temp64 = (u64) (rate - div * parent_rate); | ||
241 | temp64 *= mfd; | ||
242 | do_div(temp64, parent_rate); | ||
243 | mfn = temp64; | ||
244 | |||
245 | return parent_rate * div + parent_rate / mfd * mfn; | ||
246 | } | ||
247 | |||
248 | static int clk_pllv3_av_set_rate(struct clk_hw *hw, unsigned long rate, | ||
249 | unsigned long parent_rate) | ||
250 | { | ||
251 | struct clk_pllv3 *pll = to_clk_pllv3(hw); | ||
252 | unsigned long min_rate = parent_rate * 27; | ||
253 | unsigned long max_rate = parent_rate * 54; | ||
254 | u32 val, div; | ||
255 | u32 mfn, mfd = 1000000; | ||
256 | s64 temp64; | ||
257 | |||
258 | if (rate < min_rate || rate > max_rate) | ||
259 | return -EINVAL; | ||
260 | |||
261 | div = rate / parent_rate; | ||
262 | temp64 = (u64) (rate - div * parent_rate); | ||
263 | temp64 *= mfd; | ||
264 | do_div(temp64, parent_rate); | ||
265 | mfn = temp64; | ||
266 | |||
267 | val = readl_relaxed(pll->base); | ||
268 | val &= ~pll->div_mask; | ||
269 | val |= div; | ||
270 | writel_relaxed(val, pll->base); | ||
271 | writel_relaxed(mfn, pll->base + PLL_NUM_OFFSET); | ||
272 | writel_relaxed(mfd, pll->base + PLL_DENOM_OFFSET); | ||
273 | |||
274 | return 0; | ||
275 | } | ||
276 | |||
277 | static const struct clk_ops clk_pllv3_av_ops = { | ||
278 | .prepare = clk_pllv3_prepare, | ||
279 | .unprepare = clk_pllv3_unprepare, | ||
280 | .enable = clk_pllv3_enable, | ||
281 | .disable = clk_pllv3_disable, | ||
282 | .recalc_rate = clk_pllv3_av_recalc_rate, | ||
283 | .round_rate = clk_pllv3_av_round_rate, | ||
284 | .set_rate = clk_pllv3_av_set_rate, | ||
285 | }; | ||
286 | |||
287 | static unsigned long clk_pllv3_enet_recalc_rate(struct clk_hw *hw, | ||
288 | unsigned long parent_rate) | ||
289 | { | ||
290 | struct clk_pllv3 *pll = to_clk_pllv3(hw); | ||
291 | u32 div = readl_relaxed(pll->base) & pll->div_mask; | ||
292 | |||
293 | switch (div) { | ||
294 | case 0: | ||
295 | return 25000000; | ||
296 | case 1: | ||
297 | return 50000000; | ||
298 | case 2: | ||
299 | return 100000000; | ||
300 | case 3: | ||
301 | return 125000000; | ||
302 | } | ||
303 | |||
304 | return 0; | ||
305 | } | ||
306 | |||
307 | static long clk_pllv3_enet_round_rate(struct clk_hw *hw, unsigned long rate, | ||
308 | unsigned long *prate) | ||
309 | { | ||
310 | if (rate >= 125000000) | ||
311 | rate = 125000000; | ||
312 | else if (rate >= 100000000) | ||
313 | rate = 100000000; | ||
314 | else if (rate >= 50000000) | ||
315 | rate = 50000000; | ||
316 | else | ||
317 | rate = 25000000; | ||
318 | return rate; | ||
319 | } | ||
320 | |||
321 | static int clk_pllv3_enet_set_rate(struct clk_hw *hw, unsigned long rate, | ||
322 | unsigned long parent_rate) | ||
323 | { | ||
324 | struct clk_pllv3 *pll = to_clk_pllv3(hw); | ||
325 | u32 val, div; | ||
326 | |||
327 | switch (rate) { | ||
328 | case 25000000: | ||
329 | div = 0; | ||
330 | break; | ||
331 | case 50000000: | ||
332 | div = 1; | ||
333 | break; | ||
334 | case 100000000: | ||
335 | div = 2; | ||
336 | break; | ||
337 | case 125000000: | ||
338 | div = 3; | ||
339 | break; | ||
340 | default: | ||
341 | return -EINVAL; | ||
342 | } | ||
343 | |||
344 | val = readl_relaxed(pll->base); | ||
345 | val &= ~pll->div_mask; | ||
346 | val |= div; | ||
347 | writel_relaxed(val, pll->base); | ||
348 | |||
349 | return 0; | ||
350 | } | ||
351 | |||
352 | static const struct clk_ops clk_pllv3_enet_ops = { | ||
353 | .prepare = clk_pllv3_prepare, | ||
354 | .unprepare = clk_pllv3_unprepare, | ||
355 | .enable = clk_pllv3_enable, | ||
356 | .disable = clk_pllv3_disable, | ||
357 | .recalc_rate = clk_pllv3_enet_recalc_rate, | ||
358 | .round_rate = clk_pllv3_enet_round_rate, | ||
359 | .set_rate = clk_pllv3_enet_set_rate, | ||
360 | }; | ||
361 | |||
362 | static const struct clk_ops clk_pllv3_mlb_ops = { | ||
363 | .prepare = clk_pllv3_prepare, | ||
364 | .unprepare = clk_pllv3_unprepare, | ||
365 | .enable = clk_pllv3_enable, | ||
366 | .disable = clk_pllv3_disable, | ||
367 | }; | ||
368 | |||
369 | struct clk *imx_clk_pllv3(enum imx_pllv3_type type, const char *name, | ||
370 | const char *parent_name, void __iomem *base, | ||
371 | u32 gate_mask, u32 div_mask) | ||
372 | { | ||
373 | struct clk_pllv3 *pll; | ||
374 | const struct clk_ops *ops; | ||
375 | struct clk *clk; | ||
376 | struct clk_init_data init; | ||
377 | |||
378 | pll = kzalloc(sizeof(*pll), GFP_KERNEL); | ||
379 | if (!pll) | ||
380 | return ERR_PTR(-ENOMEM); | ||
381 | |||
382 | switch (type) { | ||
383 | case IMX_PLLV3_SYS: | ||
384 | ops = &clk_pllv3_sys_ops; | ||
385 | break; | ||
386 | case IMX_PLLV3_USB: | ||
387 | ops = &clk_pllv3_ops; | ||
388 | pll->powerup_set = true; | ||
389 | break; | ||
390 | case IMX_PLLV3_AV: | ||
391 | ops = &clk_pllv3_av_ops; | ||
392 | break; | ||
393 | case IMX_PLLV3_ENET: | ||
394 | ops = &clk_pllv3_enet_ops; | ||
395 | break; | ||
396 | case IMX_PLLV3_MLB: | ||
397 | ops = &clk_pllv3_mlb_ops; | ||
398 | break; | ||
399 | default: | ||
400 | ops = &clk_pllv3_ops; | ||
401 | } | ||
402 | pll->base = base; | ||
403 | pll->gate_mask = gate_mask; | ||
404 | pll->div_mask = div_mask; | ||
405 | |||
406 | init.name = name; | ||
407 | init.ops = ops; | ||
408 | init.flags = 0; | ||
409 | init.parent_names = &parent_name; | ||
410 | init.num_parents = 1; | ||
411 | |||
412 | pll->hw.init = &init; | ||
413 | |||
414 | clk = clk_register(NULL, &pll->hw); | ||
415 | if (IS_ERR(clk)) | ||
416 | kfree(pll); | ||
417 | |||
418 | return clk; | ||
419 | } | ||
diff --git a/arch/arm/mach-imx/clk.h b/arch/arm/mach-imx/clk.h new file mode 100644 index 000000000000..1bf64fe2523c --- /dev/null +++ b/arch/arm/mach-imx/clk.h | |||
@@ -0,0 +1,83 @@ | |||
1 | #ifndef __MACH_IMX_CLK_H | ||
2 | #define __MACH_IMX_CLK_H | ||
3 | |||
4 | #include <linux/spinlock.h> | ||
5 | #include <linux/clk-provider.h> | ||
6 | #include <mach/clock.h> | ||
7 | |||
8 | struct clk *imx_clk_pllv1(const char *name, const char *parent, | ||
9 | void __iomem *base); | ||
10 | |||
11 | struct clk *imx_clk_pllv2(const char *name, const char *parent, | ||
12 | void __iomem *base); | ||
13 | |||
14 | enum imx_pllv3_type { | ||
15 | IMX_PLLV3_GENERIC, | ||
16 | IMX_PLLV3_SYS, | ||
17 | IMX_PLLV3_USB, | ||
18 | IMX_PLLV3_AV, | ||
19 | IMX_PLLV3_ENET, | ||
20 | IMX_PLLV3_MLB, | ||
21 | }; | ||
22 | |||
23 | struct clk *imx_clk_pllv3(enum imx_pllv3_type type, const char *name, | ||
24 | const char *parent_name, void __iomem *base, u32 gate_mask, | ||
25 | u32 div_mask); | ||
26 | |||
27 | struct clk *clk_register_gate2(struct device *dev, const char *name, | ||
28 | const char *parent_name, unsigned long flags, | ||
29 | void __iomem *reg, u8 bit_idx, | ||
30 | u8 clk_gate_flags, spinlock_t *lock); | ||
31 | |||
32 | static inline struct clk *imx_clk_gate2(const char *name, const char *parent, | ||
33 | void __iomem *reg, u8 shift) | ||
34 | { | ||
35 | return clk_register_gate2(NULL, name, parent, CLK_SET_RATE_PARENT, reg, | ||
36 | shift, 0, &imx_ccm_lock); | ||
37 | } | ||
38 | |||
39 | struct clk *imx_clk_pfd(const char *name, const char *parent_name, | ||
40 | void __iomem *reg, u8 idx); | ||
41 | |||
42 | struct clk *imx_clk_busy_divider(const char *name, const char *parent_name, | ||
43 | void __iomem *reg, u8 shift, u8 width, | ||
44 | void __iomem *busy_reg, u8 busy_shift); | ||
45 | |||
46 | struct clk *imx_clk_busy_mux(const char *name, void __iomem *reg, u8 shift, | ||
47 | u8 width, void __iomem *busy_reg, u8 busy_shift, | ||
48 | const char **parent_names, int num_parents); | ||
49 | |||
50 | static inline struct clk *imx_clk_fixed(const char *name, int rate) | ||
51 | { | ||
52 | return clk_register_fixed_rate(NULL, name, NULL, CLK_IS_ROOT, rate); | ||
53 | } | ||
54 | |||
55 | static inline struct clk *imx_clk_divider(const char *name, const char *parent, | ||
56 | void __iomem *reg, u8 shift, u8 width) | ||
57 | { | ||
58 | return clk_register_divider(NULL, name, parent, CLK_SET_RATE_PARENT, | ||
59 | reg, shift, width, 0, &imx_ccm_lock); | ||
60 | } | ||
61 | |||
62 | static inline struct clk *imx_clk_gate(const char *name, const char *parent, | ||
63 | void __iomem *reg, u8 shift) | ||
64 | { | ||
65 | return clk_register_gate(NULL, name, parent, CLK_SET_RATE_PARENT, reg, | ||
66 | shift, 0, &imx_ccm_lock); | ||
67 | } | ||
68 | |||
69 | static inline struct clk *imx_clk_mux(const char *name, void __iomem *reg, | ||
70 | u8 shift, u8 width, const char **parents, int num_parents) | ||
71 | { | ||
72 | return clk_register_mux(NULL, name, parents, num_parents, 0, reg, shift, | ||
73 | width, 0, &imx_ccm_lock); | ||
74 | } | ||
75 | |||
76 | static inline struct clk *imx_clk_fixed_factor(const char *name, | ||
77 | const char *parent, unsigned int mult, unsigned int div) | ||
78 | { | ||
79 | return clk_register_fixed_factor(NULL, name, parent, | ||
80 | CLK_SET_RATE_PARENT, mult, div); | ||
81 | } | ||
82 | |||
83 | #endif | ||
diff --git a/arch/arm/mach-imx/clock-imx1.c b/arch/arm/mach-imx/clock-imx1.c deleted file mode 100644 index 4aabeb241563..000000000000 --- a/arch/arm/mach-imx/clock-imx1.c +++ /dev/null | |||
@@ -1,636 +0,0 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2008 Sascha Hauer <s.hauer@pengutronix.de>, Pengutronix | ||
3 | * | ||
4 | * This program is free software; you can redistribute it and/or modify | ||
5 | * it under the terms of the GNU General Public License version 2 as | ||
6 | * published by the Free Software Foundation. | ||
7 | * | ||
8 | * This program is distributed in the hope that it will be useful, | ||
9 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
10 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
11 | * GNU General Public License for more details. | ||
12 | * | ||
13 | * You should have received a copy of the GNU General Public License along | ||
14 | * with this program; if not, write to the Free Software Foundation, Inc., | ||
15 | * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA. | ||
16 | */ | ||
17 | |||
18 | #include <linux/kernel.h> | ||
19 | #include <linux/init.h> | ||
20 | #include <linux/list.h> | ||
21 | #include <linux/math64.h> | ||
22 | #include <linux/err.h> | ||
23 | #include <linux/clk.h> | ||
24 | #include <linux/io.h> | ||
25 | #include <linux/clkdev.h> | ||
26 | |||
27 | #include <mach/clock.h> | ||
28 | #include <mach/hardware.h> | ||
29 | #include <mach/common.h> | ||
30 | |||
31 | #define IO_ADDR_CCM(off) (MX1_IO_ADDRESS(MX1_CCM_BASE_ADDR + (off))) | ||
32 | |||
33 | /* CCM register addresses */ | ||
34 | #define CCM_CSCR IO_ADDR_CCM(0x0) | ||
35 | #define CCM_MPCTL0 IO_ADDR_CCM(0x4) | ||
36 | #define CCM_SPCTL0 IO_ADDR_CCM(0xc) | ||
37 | #define CCM_PCDR IO_ADDR_CCM(0x20) | ||
38 | |||
39 | #define CCM_CSCR_CLKO_OFFSET 29 | ||
40 | #define CCM_CSCR_CLKO_MASK (0x7 << 29) | ||
41 | #define CCM_CSCR_USB_OFFSET 26 | ||
42 | #define CCM_CSCR_USB_MASK (0x7 << 26) | ||
43 | #define CCM_CSCR_OSC_EN_SHIFT 17 | ||
44 | #define CCM_CSCR_SYSTEM_SEL (1 << 16) | ||
45 | #define CCM_CSCR_BCLK_OFFSET 10 | ||
46 | #define CCM_CSCR_BCLK_MASK (0xf << 10) | ||
47 | #define CCM_CSCR_PRESC (1 << 15) | ||
48 | |||
49 | #define CCM_PCDR_PCLK3_OFFSET 16 | ||
50 | #define CCM_PCDR_PCLK3_MASK (0x7f << 16) | ||
51 | #define CCM_PCDR_PCLK2_OFFSET 4 | ||
52 | #define CCM_PCDR_PCLK2_MASK (0xf << 4) | ||
53 | #define CCM_PCDR_PCLK1_OFFSET 0 | ||
54 | #define CCM_PCDR_PCLK1_MASK 0xf | ||
55 | |||
56 | #define IO_ADDR_SCM(off) (MX1_IO_ADDRESS(MX1_SCM_BASE_ADDR + (off))) | ||
57 | |||
58 | /* SCM register addresses */ | ||
59 | #define SCM_GCCR IO_ADDR_SCM(0xc) | ||
60 | |||
61 | #define SCM_GCCR_DMA_CLK_EN_OFFSET 3 | ||
62 | #define SCM_GCCR_CSI_CLK_EN_OFFSET 2 | ||
63 | #define SCM_GCCR_MMA_CLK_EN_OFFSET 1 | ||
64 | #define SCM_GCCR_USBD_CLK_EN_OFFSET 0 | ||
65 | |||
66 | static int _clk_enable(struct clk *clk) | ||
67 | { | ||
68 | unsigned int reg; | ||
69 | |||
70 | reg = __raw_readl(clk->enable_reg); | ||
71 | reg |= 1 << clk->enable_shift; | ||
72 | __raw_writel(reg, clk->enable_reg); | ||
73 | |||
74 | return 0; | ||
75 | } | ||
76 | |||
77 | static void _clk_disable(struct clk *clk) | ||
78 | { | ||
79 | unsigned int reg; | ||
80 | |||
81 | reg = __raw_readl(clk->enable_reg); | ||
82 | reg &= ~(1 << clk->enable_shift); | ||
83 | __raw_writel(reg, clk->enable_reg); | ||
84 | } | ||
85 | |||
86 | static int _clk_can_use_parent(const struct clk *clk_arr[], unsigned int size, | ||
87 | struct clk *parent) | ||
88 | { | ||
89 | int i; | ||
90 | |||
91 | for (i = 0; i < size; i++) | ||
92 | if (parent == clk_arr[i]) | ||
93 | return i; | ||
94 | |||
95 | return -EINVAL; | ||
96 | } | ||
97 | |||
98 | static unsigned long | ||
99 | _clk_simple_round_rate(struct clk *clk, unsigned long rate, unsigned int limit) | ||
100 | { | ||
101 | int div; | ||
102 | unsigned long parent_rate; | ||
103 | |||
104 | parent_rate = clk_get_rate(clk->parent); | ||
105 | |||
106 | div = parent_rate / rate; | ||
107 | if (parent_rate % rate) | ||
108 | div++; | ||
109 | |||
110 | if (div > limit) | ||
111 | div = limit; | ||
112 | |||
113 | return parent_rate / div; | ||
114 | } | ||
115 | |||
116 | static unsigned long _clk_parent_round_rate(struct clk *clk, unsigned long rate) | ||
117 | { | ||
118 | return clk->parent->round_rate(clk->parent, rate); | ||
119 | } | ||
120 | |||
121 | static int _clk_parent_set_rate(struct clk *clk, unsigned long rate) | ||
122 | { | ||
123 | return clk->parent->set_rate(clk->parent, rate); | ||
124 | } | ||
125 | |||
126 | static unsigned long clk16m_get_rate(struct clk *clk) | ||
127 | { | ||
128 | return 16000000; | ||
129 | } | ||
130 | |||
131 | static struct clk clk16m = { | ||
132 | .get_rate = clk16m_get_rate, | ||
133 | .enable = _clk_enable, | ||
134 | .enable_reg = CCM_CSCR, | ||
135 | .enable_shift = CCM_CSCR_OSC_EN_SHIFT, | ||
136 | .disable = _clk_disable, | ||
137 | }; | ||
138 | |||
139 | /* in Hz */ | ||
140 | static unsigned long clk32_rate; | ||
141 | |||
142 | static unsigned long clk32_get_rate(struct clk *clk) | ||
143 | { | ||
144 | return clk32_rate; | ||
145 | } | ||
146 | |||
147 | static struct clk clk32 = { | ||
148 | .get_rate = clk32_get_rate, | ||
149 | }; | ||
150 | |||
151 | static unsigned long clk32_premult_get_rate(struct clk *clk) | ||
152 | { | ||
153 | return clk_get_rate(clk->parent) * 512; | ||
154 | } | ||
155 | |||
156 | static struct clk clk32_premult = { | ||
157 | .parent = &clk32, | ||
158 | .get_rate = clk32_premult_get_rate, | ||
159 | }; | ||
160 | |||
161 | static const struct clk *prem_clk_clocks[] = { | ||
162 | &clk32_premult, | ||
163 | &clk16m, | ||
164 | }; | ||
165 | |||
166 | static int prem_clk_set_parent(struct clk *clk, struct clk *parent) | ||
167 | { | ||
168 | int i; | ||
169 | unsigned int reg = __raw_readl(CCM_CSCR); | ||
170 | |||
171 | i = _clk_can_use_parent(prem_clk_clocks, ARRAY_SIZE(prem_clk_clocks), | ||
172 | parent); | ||
173 | |||
174 | switch (i) { | ||
175 | case 0: | ||
176 | reg &= ~CCM_CSCR_SYSTEM_SEL; | ||
177 | break; | ||
178 | case 1: | ||
179 | reg |= CCM_CSCR_SYSTEM_SEL; | ||
180 | break; | ||
181 | default: | ||
182 | return i; | ||
183 | } | ||
184 | |||
185 | __raw_writel(reg, CCM_CSCR); | ||
186 | |||
187 | return 0; | ||
188 | } | ||
189 | |||
190 | static struct clk prem_clk = { | ||
191 | .set_parent = prem_clk_set_parent, | ||
192 | }; | ||
193 | |||
194 | static unsigned long system_clk_get_rate(struct clk *clk) | ||
195 | { | ||
196 | return mxc_decode_pll(__raw_readl(CCM_SPCTL0), | ||
197 | clk_get_rate(clk->parent)); | ||
198 | } | ||
199 | |||
200 | static struct clk system_clk = { | ||
201 | .parent = &prem_clk, | ||
202 | .get_rate = system_clk_get_rate, | ||
203 | }; | ||
204 | |||
205 | static unsigned long mcu_clk_get_rate(struct clk *clk) | ||
206 | { | ||
207 | return mxc_decode_pll(__raw_readl(CCM_MPCTL0), | ||
208 | clk_get_rate(clk->parent)); | ||
209 | } | ||
210 | |||
211 | static struct clk mcu_clk = { | ||
212 | .parent = &clk32_premult, | ||
213 | .get_rate = mcu_clk_get_rate, | ||
214 | }; | ||
215 | |||
216 | static unsigned long fclk_get_rate(struct clk *clk) | ||
217 | { | ||
218 | unsigned long fclk = clk_get_rate(clk->parent); | ||
219 | |||
220 | if (__raw_readl(CCM_CSCR) & CCM_CSCR_PRESC) | ||
221 | fclk /= 2; | ||
222 | |||
223 | return fclk; | ||
224 | } | ||
225 | |||
226 | static struct clk fclk = { | ||
227 | .parent = &mcu_clk, | ||
228 | .get_rate = fclk_get_rate, | ||
229 | }; | ||
230 | |||
231 | /* | ||
232 | * get hclk ( SDRAM, CSI, Memory Stick, I2C, DMA ) | ||
233 | */ | ||
234 | static unsigned long hclk_get_rate(struct clk *clk) | ||
235 | { | ||
236 | return clk_get_rate(clk->parent) / (((__raw_readl(CCM_CSCR) & | ||
237 | CCM_CSCR_BCLK_MASK) >> CCM_CSCR_BCLK_OFFSET) + 1); | ||
238 | } | ||
239 | |||
240 | static unsigned long hclk_round_rate(struct clk *clk, unsigned long rate) | ||
241 | { | ||
242 | return _clk_simple_round_rate(clk, rate, 16); | ||
243 | } | ||
244 | |||
245 | static int hclk_set_rate(struct clk *clk, unsigned long rate) | ||
246 | { | ||
247 | unsigned int div; | ||
248 | unsigned int reg; | ||
249 | unsigned long parent_rate; | ||
250 | |||
251 | parent_rate = clk_get_rate(clk->parent); | ||
252 | |||
253 | div = parent_rate / rate; | ||
254 | |||
255 | if (div > 16 || div < 1 || ((parent_rate / div) != rate)) | ||
256 | return -EINVAL; | ||
257 | |||
258 | div--; | ||
259 | |||
260 | reg = __raw_readl(CCM_CSCR); | ||
261 | reg &= ~CCM_CSCR_BCLK_MASK; | ||
262 | reg |= div << CCM_CSCR_BCLK_OFFSET; | ||
263 | __raw_writel(reg, CCM_CSCR); | ||
264 | |||
265 | return 0; | ||
266 | } | ||
267 | |||
268 | static struct clk hclk = { | ||
269 | .parent = &system_clk, | ||
270 | .get_rate = hclk_get_rate, | ||
271 | .round_rate = hclk_round_rate, | ||
272 | .set_rate = hclk_set_rate, | ||
273 | }; | ||
274 | |||
275 | static unsigned long clk48m_get_rate(struct clk *clk) | ||
276 | { | ||
277 | return clk_get_rate(clk->parent) / (((__raw_readl(CCM_CSCR) & | ||
278 | CCM_CSCR_USB_MASK) >> CCM_CSCR_USB_OFFSET) + 1); | ||
279 | } | ||
280 | |||
281 | static unsigned long clk48m_round_rate(struct clk *clk, unsigned long rate) | ||
282 | { | ||
283 | return _clk_simple_round_rate(clk, rate, 8); | ||
284 | } | ||
285 | |||
286 | static int clk48m_set_rate(struct clk *clk, unsigned long rate) | ||
287 | { | ||
288 | unsigned int div; | ||
289 | unsigned int reg; | ||
290 | unsigned long parent_rate; | ||
291 | |||
292 | parent_rate = clk_get_rate(clk->parent); | ||
293 | |||
294 | div = parent_rate / rate; | ||
295 | |||
296 | if (div > 8 || div < 1 || ((parent_rate / div) != rate)) | ||
297 | return -EINVAL; | ||
298 | |||
299 | div--; | ||
300 | |||
301 | reg = __raw_readl(CCM_CSCR); | ||
302 | reg &= ~CCM_CSCR_USB_MASK; | ||
303 | reg |= div << CCM_CSCR_USB_OFFSET; | ||
304 | __raw_writel(reg, CCM_CSCR); | ||
305 | |||
306 | return 0; | ||
307 | } | ||
308 | |||
309 | static struct clk clk48m = { | ||
310 | .parent = &system_clk, | ||
311 | .get_rate = clk48m_get_rate, | ||
312 | .round_rate = clk48m_round_rate, | ||
313 | .set_rate = clk48m_set_rate, | ||
314 | }; | ||
315 | |||
316 | /* | ||
317 | * get peripheral clock 1 ( UART[12], Timer[12], PWM ) | ||
318 | */ | ||
319 | static unsigned long perclk1_get_rate(struct clk *clk) | ||
320 | { | ||
321 | return clk_get_rate(clk->parent) / (((__raw_readl(CCM_PCDR) & | ||
322 | CCM_PCDR_PCLK1_MASK) >> CCM_PCDR_PCLK1_OFFSET) + 1); | ||
323 | } | ||
324 | |||
325 | static unsigned long perclk1_round_rate(struct clk *clk, unsigned long rate) | ||
326 | { | ||
327 | return _clk_simple_round_rate(clk, rate, 16); | ||
328 | } | ||
329 | |||
330 | static int perclk1_set_rate(struct clk *clk, unsigned long rate) | ||
331 | { | ||
332 | unsigned int div; | ||
333 | unsigned int reg; | ||
334 | unsigned long parent_rate; | ||
335 | |||
336 | parent_rate = clk_get_rate(clk->parent); | ||
337 | |||
338 | div = parent_rate / rate; | ||
339 | |||
340 | if (div > 16 || div < 1 || ((parent_rate / div) != rate)) | ||
341 | return -EINVAL; | ||
342 | |||
343 | div--; | ||
344 | |||
345 | reg = __raw_readl(CCM_PCDR); | ||
346 | reg &= ~CCM_PCDR_PCLK1_MASK; | ||
347 | reg |= div << CCM_PCDR_PCLK1_OFFSET; | ||
348 | __raw_writel(reg, CCM_PCDR); | ||
349 | |||
350 | return 0; | ||
351 | } | ||
352 | |||
353 | /* | ||
354 | * get peripheral clock 2 ( LCD, SD, SPI[12] ) | ||
355 | */ | ||
356 | static unsigned long perclk2_get_rate(struct clk *clk) | ||
357 | { | ||
358 | return clk_get_rate(clk->parent) / (((__raw_readl(CCM_PCDR) & | ||
359 | CCM_PCDR_PCLK2_MASK) >> CCM_PCDR_PCLK2_OFFSET) + 1); | ||
360 | } | ||
361 | |||
362 | static unsigned long perclk2_round_rate(struct clk *clk, unsigned long rate) | ||
363 | { | ||
364 | return _clk_simple_round_rate(clk, rate, 16); | ||
365 | } | ||
366 | |||
367 | static int perclk2_set_rate(struct clk *clk, unsigned long rate) | ||
368 | { | ||
369 | unsigned int div; | ||
370 | unsigned int reg; | ||
371 | unsigned long parent_rate; | ||
372 | |||
373 | parent_rate = clk_get_rate(clk->parent); | ||
374 | |||
375 | div = parent_rate / rate; | ||
376 | |||
377 | if (div > 16 || div < 1 || ((parent_rate / div) != rate)) | ||
378 | return -EINVAL; | ||
379 | |||
380 | div--; | ||
381 | |||
382 | reg = __raw_readl(CCM_PCDR); | ||
383 | reg &= ~CCM_PCDR_PCLK2_MASK; | ||
384 | reg |= div << CCM_PCDR_PCLK2_OFFSET; | ||
385 | __raw_writel(reg, CCM_PCDR); | ||
386 | |||
387 | return 0; | ||
388 | } | ||
389 | |||
390 | /* | ||
391 | * get peripheral clock 3 ( SSI ) | ||
392 | */ | ||
393 | static unsigned long perclk3_get_rate(struct clk *clk) | ||
394 | { | ||
395 | return clk_get_rate(clk->parent) / (((__raw_readl(CCM_PCDR) & | ||
396 | CCM_PCDR_PCLK3_MASK) >> CCM_PCDR_PCLK3_OFFSET) + 1); | ||
397 | } | ||
398 | |||
399 | static unsigned long perclk3_round_rate(struct clk *clk, unsigned long rate) | ||
400 | { | ||
401 | return _clk_simple_round_rate(clk, rate, 128); | ||
402 | } | ||
403 | |||
404 | static int perclk3_set_rate(struct clk *clk, unsigned long rate) | ||
405 | { | ||
406 | unsigned int div; | ||
407 | unsigned int reg; | ||
408 | unsigned long parent_rate; | ||
409 | |||
410 | parent_rate = clk_get_rate(clk->parent); | ||
411 | |||
412 | div = parent_rate / rate; | ||
413 | |||
414 | if (div > 128 || div < 1 || ((parent_rate / div) != rate)) | ||
415 | return -EINVAL; | ||
416 | |||
417 | div--; | ||
418 | |||
419 | reg = __raw_readl(CCM_PCDR); | ||
420 | reg &= ~CCM_PCDR_PCLK3_MASK; | ||
421 | reg |= div << CCM_PCDR_PCLK3_OFFSET; | ||
422 | __raw_writel(reg, CCM_PCDR); | ||
423 | |||
424 | return 0; | ||
425 | } | ||
426 | |||
427 | static struct clk perclk[] = { | ||
428 | { | ||
429 | .id = 0, | ||
430 | .parent = &system_clk, | ||
431 | .get_rate = perclk1_get_rate, | ||
432 | .round_rate = perclk1_round_rate, | ||
433 | .set_rate = perclk1_set_rate, | ||
434 | }, { | ||
435 | .id = 1, | ||
436 | .parent = &system_clk, | ||
437 | .get_rate = perclk2_get_rate, | ||
438 | .round_rate = perclk2_round_rate, | ||
439 | .set_rate = perclk2_set_rate, | ||
440 | }, { | ||
441 | .id = 2, | ||
442 | .parent = &system_clk, | ||
443 | .get_rate = perclk3_get_rate, | ||
444 | .round_rate = perclk3_round_rate, | ||
445 | .set_rate = perclk3_set_rate, | ||
446 | } | ||
447 | }; | ||
448 | |||
449 | static const struct clk *clko_clocks[] = { | ||
450 | &perclk[0], | ||
451 | &hclk, | ||
452 | &clk48m, | ||
453 | &clk16m, | ||
454 | &prem_clk, | ||
455 | &fclk, | ||
456 | }; | ||
457 | |||
458 | static int clko_set_parent(struct clk *clk, struct clk *parent) | ||
459 | { | ||
460 | int i; | ||
461 | unsigned int reg; | ||
462 | |||
463 | i = _clk_can_use_parent(clko_clocks, ARRAY_SIZE(clko_clocks), parent); | ||
464 | if (i < 0) | ||
465 | return i; | ||
466 | |||
467 | reg = __raw_readl(CCM_CSCR) & ~CCM_CSCR_CLKO_MASK; | ||
468 | reg |= i << CCM_CSCR_CLKO_OFFSET; | ||
469 | __raw_writel(reg, CCM_CSCR); | ||
470 | |||
471 | if (clko_clocks[i]->set_rate && clko_clocks[i]->round_rate) { | ||
472 | clk->set_rate = _clk_parent_set_rate; | ||
473 | clk->round_rate = _clk_parent_round_rate; | ||
474 | } else { | ||
475 | clk->set_rate = NULL; | ||
476 | clk->round_rate = NULL; | ||
477 | } | ||
478 | |||
479 | return 0; | ||
480 | } | ||
481 | |||
482 | static struct clk clko_clk = { | ||
483 | .set_parent = clko_set_parent, | ||
484 | }; | ||
485 | |||
486 | static struct clk dma_clk = { | ||
487 | .parent = &hclk, | ||
488 | .round_rate = _clk_parent_round_rate, | ||
489 | .set_rate = _clk_parent_set_rate, | ||
490 | .enable = _clk_enable, | ||
491 | .enable_reg = SCM_GCCR, | ||
492 | .enable_shift = SCM_GCCR_DMA_CLK_EN_OFFSET, | ||
493 | .disable = _clk_disable, | ||
494 | }; | ||
495 | |||
496 | static struct clk csi_clk = { | ||
497 | .parent = &hclk, | ||
498 | .round_rate = _clk_parent_round_rate, | ||
499 | .set_rate = _clk_parent_set_rate, | ||
500 | .enable = _clk_enable, | ||
501 | .enable_reg = SCM_GCCR, | ||
502 | .enable_shift = SCM_GCCR_CSI_CLK_EN_OFFSET, | ||
503 | .disable = _clk_disable, | ||
504 | }; | ||
505 | |||
506 | static struct clk mma_clk = { | ||
507 | .parent = &hclk, | ||
508 | .round_rate = _clk_parent_round_rate, | ||
509 | .set_rate = _clk_parent_set_rate, | ||
510 | .enable = _clk_enable, | ||
511 | .enable_reg = SCM_GCCR, | ||
512 | .enable_shift = SCM_GCCR_MMA_CLK_EN_OFFSET, | ||
513 | .disable = _clk_disable, | ||
514 | }; | ||
515 | |||
516 | static struct clk usbd_clk = { | ||
517 | .parent = &clk48m, | ||
518 | .round_rate = _clk_parent_round_rate, | ||
519 | .set_rate = _clk_parent_set_rate, | ||
520 | .enable = _clk_enable, | ||
521 | .enable_reg = SCM_GCCR, | ||
522 | .enable_shift = SCM_GCCR_USBD_CLK_EN_OFFSET, | ||
523 | .disable = _clk_disable, | ||
524 | }; | ||
525 | |||
526 | static struct clk gpt_clk = { | ||
527 | .parent = &perclk[0], | ||
528 | .round_rate = _clk_parent_round_rate, | ||
529 | .set_rate = _clk_parent_set_rate, | ||
530 | }; | ||
531 | |||
532 | static struct clk uart_clk = { | ||
533 | .parent = &perclk[0], | ||
534 | .round_rate = _clk_parent_round_rate, | ||
535 | .set_rate = _clk_parent_set_rate, | ||
536 | }; | ||
537 | |||
538 | static struct clk i2c_clk = { | ||
539 | .parent = &hclk, | ||
540 | .round_rate = _clk_parent_round_rate, | ||
541 | .set_rate = _clk_parent_set_rate, | ||
542 | }; | ||
543 | |||
544 | static struct clk spi_clk = { | ||
545 | .parent = &perclk[1], | ||
546 | .round_rate = _clk_parent_round_rate, | ||
547 | .set_rate = _clk_parent_set_rate, | ||
548 | }; | ||
549 | |||
550 | static struct clk sdhc_clk = { | ||
551 | .parent = &perclk[1], | ||
552 | .round_rate = _clk_parent_round_rate, | ||
553 | .set_rate = _clk_parent_set_rate, | ||
554 | }; | ||
555 | |||
556 | static struct clk lcdc_clk = { | ||
557 | .parent = &perclk[1], | ||
558 | .round_rate = _clk_parent_round_rate, | ||
559 | .set_rate = _clk_parent_set_rate, | ||
560 | }; | ||
561 | |||
562 | static struct clk mshc_clk = { | ||
563 | .parent = &hclk, | ||
564 | .round_rate = _clk_parent_round_rate, | ||
565 | .set_rate = _clk_parent_set_rate, | ||
566 | }; | ||
567 | |||
568 | static struct clk ssi_clk = { | ||
569 | .parent = &perclk[2], | ||
570 | .round_rate = _clk_parent_round_rate, | ||
571 | .set_rate = _clk_parent_set_rate, | ||
572 | }; | ||
573 | |||
574 | static struct clk rtc_clk = { | ||
575 | .parent = &clk32, | ||
576 | }; | ||
577 | |||
578 | #define _REGISTER_CLOCK(d, n, c) \ | ||
579 | { \ | ||
580 | .dev_id = d, \ | ||
581 | .con_id = n, \ | ||
582 | .clk = &c, \ | ||
583 | }, | ||
584 | static struct clk_lookup lookups[] __initdata = { | ||
585 | _REGISTER_CLOCK(NULL, "dma", dma_clk) | ||
586 | _REGISTER_CLOCK("mx1-camera.0", NULL, csi_clk) | ||
587 | _REGISTER_CLOCK(NULL, "mma", mma_clk) | ||
588 | _REGISTER_CLOCK("imx_udc.0", NULL, usbd_clk) | ||
589 | _REGISTER_CLOCK(NULL, "gpt", gpt_clk) | ||
590 | _REGISTER_CLOCK("imx1-uart.0", NULL, uart_clk) | ||
591 | _REGISTER_CLOCK("imx1-uart.1", NULL, uart_clk) | ||
592 | _REGISTER_CLOCK("imx1-uart.2", NULL, uart_clk) | ||
593 | _REGISTER_CLOCK("imx-i2c.0", NULL, i2c_clk) | ||
594 | _REGISTER_CLOCK("imx1-cspi.0", NULL, spi_clk) | ||
595 | _REGISTER_CLOCK("imx1-cspi.1", NULL, spi_clk) | ||
596 | _REGISTER_CLOCK("imx-mmc.0", NULL, sdhc_clk) | ||
597 | _REGISTER_CLOCK("imx-fb.0", NULL, lcdc_clk) | ||
598 | _REGISTER_CLOCK(NULL, "mshc", mshc_clk) | ||
599 | _REGISTER_CLOCK(NULL, "ssi", ssi_clk) | ||
600 | _REGISTER_CLOCK("mxc_rtc.0", NULL, rtc_clk) | ||
601 | }; | ||
602 | |||
603 | int __init mx1_clocks_init(unsigned long fref) | ||
604 | { | ||
605 | unsigned int reg; | ||
606 | |||
607 | /* disable clocks we are able to */ | ||
608 | __raw_writel(0, SCM_GCCR); | ||
609 | |||
610 | clk32_rate = fref; | ||
611 | reg = __raw_readl(CCM_CSCR); | ||
612 | |||
613 | /* detect clock reference for system PLL */ | ||
614 | if (reg & CCM_CSCR_SYSTEM_SEL) { | ||
615 | prem_clk.parent = &clk16m; | ||
616 | } else { | ||
617 | /* ensure that oscillator is disabled */ | ||
618 | reg &= ~(1 << CCM_CSCR_OSC_EN_SHIFT); | ||
619 | __raw_writel(reg, CCM_CSCR); | ||
620 | prem_clk.parent = &clk32_premult; | ||
621 | } | ||
622 | |||
623 | /* detect reference for CLKO */ | ||
624 | reg = (reg & CCM_CSCR_CLKO_MASK) >> CCM_CSCR_CLKO_OFFSET; | ||
625 | clko_clk.parent = (struct clk *)clko_clocks[reg]; | ||
626 | |||
627 | clkdev_add_table(lookups, ARRAY_SIZE(lookups)); | ||
628 | |||
629 | clk_enable(&hclk); | ||
630 | clk_enable(&fclk); | ||
631 | |||
632 | mxc_timer_init(&gpt_clk, MX1_IO_ADDRESS(MX1_TIM1_BASE_ADDR), | ||
633 | MX1_TIM1_INT); | ||
634 | |||
635 | return 0; | ||
636 | } | ||
diff --git a/arch/arm/mach-imx/clock-imx21.c b/arch/arm/mach-imx/clock-imx21.c deleted file mode 100644 index ee15d8c9db08..000000000000 --- a/arch/arm/mach-imx/clock-imx21.c +++ /dev/null | |||
@@ -1,1239 +0,0 @@ | |||
1 | /* | ||
2 | * Copyright 2004-2007 Freescale Semiconductor, Inc. All Rights Reserved. | ||
3 | * Copyright 2008 Juergen Beisert, kernel@pengutronix.de | ||
4 | * Copyright 2008 Martin Fuzzey, mfuzzey@gmail.com | ||
5 | * | ||
6 | * This program is free software; you can redistribute it and/or | ||
7 | * modify it under the terms of the GNU General Public License | ||
8 | * as published by the Free Software Foundation; either version 2 | ||
9 | * of the License, or (at your option) any later version. | ||
10 | * This program is distributed in the hope that it will be useful, | ||
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
13 | * GNU General Public License for more details. | ||
14 | * | ||
15 | * You should have received a copy of the GNU General Public License | ||
16 | * along with this program; if not, write to the Free Software | ||
17 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, | ||
18 | * MA 02110-1301, USA. | ||
19 | */ | ||
20 | |||
21 | #include <linux/clk.h> | ||
22 | #include <linux/io.h> | ||
23 | #include <linux/module.h> | ||
24 | #include <linux/clkdev.h> | ||
25 | |||
26 | #include <mach/clock.h> | ||
27 | #include <mach/hardware.h> | ||
28 | #include <mach/common.h> | ||
29 | #include <asm/div64.h> | ||
30 | |||
31 | #define IO_ADDR_CCM(off) (MX21_IO_ADDRESS(MX21_CCM_BASE_ADDR + (off))) | ||
32 | |||
33 | /* Register offsets */ | ||
34 | #define CCM_CSCR IO_ADDR_CCM(0x0) | ||
35 | #define CCM_MPCTL0 IO_ADDR_CCM(0x4) | ||
36 | #define CCM_MPCTL1 IO_ADDR_CCM(0x8) | ||
37 | #define CCM_SPCTL0 IO_ADDR_CCM(0xc) | ||
38 | #define CCM_SPCTL1 IO_ADDR_CCM(0x10) | ||
39 | #define CCM_OSC26MCTL IO_ADDR_CCM(0x14) | ||
40 | #define CCM_PCDR0 IO_ADDR_CCM(0x18) | ||
41 | #define CCM_PCDR1 IO_ADDR_CCM(0x1c) | ||
42 | #define CCM_PCCR0 IO_ADDR_CCM(0x20) | ||
43 | #define CCM_PCCR1 IO_ADDR_CCM(0x24) | ||
44 | #define CCM_CCSR IO_ADDR_CCM(0x28) | ||
45 | #define CCM_PMCTL IO_ADDR_CCM(0x2c) | ||
46 | #define CCM_PMCOUNT IO_ADDR_CCM(0x30) | ||
47 | #define CCM_WKGDCTL IO_ADDR_CCM(0x34) | ||
48 | |||
49 | #define CCM_CSCR_PRESC_OFFSET 29 | ||
50 | #define CCM_CSCR_PRESC_MASK (0x7 << CCM_CSCR_PRESC_OFFSET) | ||
51 | |||
52 | #define CCM_CSCR_USB_OFFSET 26 | ||
53 | #define CCM_CSCR_USB_MASK (0x7 << CCM_CSCR_USB_OFFSET) | ||
54 | #define CCM_CSCR_SD_OFFSET 24 | ||
55 | #define CCM_CSCR_SD_MASK (0x3 << CCM_CSCR_SD_OFFSET) | ||
56 | #define CCM_CSCR_SPLLRES (1 << 22) | ||
57 | #define CCM_CSCR_MPLLRES (1 << 21) | ||
58 | #define CCM_CSCR_SSI2_OFFSET 20 | ||
59 | #define CCM_CSCR_SSI2 (1 << CCM_CSCR_SSI2_OFFSET) | ||
60 | #define CCM_CSCR_SSI1_OFFSET 19 | ||
61 | #define CCM_CSCR_SSI1 (1 << CCM_CSCR_SSI1_OFFSET) | ||
62 | #define CCM_CSCR_FIR_OFFSET 18 | ||
63 | #define CCM_CSCR_FIR (1 << CCM_CSCR_FIR_OFFSET) | ||
64 | #define CCM_CSCR_SP (1 << 17) | ||
65 | #define CCM_CSCR_MCU (1 << 16) | ||
66 | #define CCM_CSCR_BCLK_OFFSET 10 | ||
67 | #define CCM_CSCR_BCLK_MASK (0xf << CCM_CSCR_BCLK_OFFSET) | ||
68 | #define CCM_CSCR_IPDIV_OFFSET 9 | ||
69 | #define CCM_CSCR_IPDIV (1 << CCM_CSCR_IPDIV_OFFSET) | ||
70 | |||
71 | #define CCM_CSCR_OSC26MDIV (1 << 4) | ||
72 | #define CCM_CSCR_OSC26M (1 << 3) | ||
73 | #define CCM_CSCR_FPM (1 << 2) | ||
74 | #define CCM_CSCR_SPEN (1 << 1) | ||
75 | #define CCM_CSCR_MPEN 1 | ||
76 | |||
77 | #define CCM_MPCTL0_CPLM (1 << 31) | ||
78 | #define CCM_MPCTL0_PD_OFFSET 26 | ||
79 | #define CCM_MPCTL0_PD_MASK (0xf << 26) | ||
80 | #define CCM_MPCTL0_MFD_OFFSET 16 | ||
81 | #define CCM_MPCTL0_MFD_MASK (0x3ff << 16) | ||
82 | #define CCM_MPCTL0_MFI_OFFSET 10 | ||
83 | #define CCM_MPCTL0_MFI_MASK (0xf << 10) | ||
84 | #define CCM_MPCTL0_MFN_OFFSET 0 | ||
85 | #define CCM_MPCTL0_MFN_MASK 0x3ff | ||
86 | |||
87 | #define CCM_MPCTL1_LF (1 << 15) | ||
88 | #define CCM_MPCTL1_BRMO (1 << 6) | ||
89 | |||
90 | #define CCM_SPCTL0_CPLM (1 << 31) | ||
91 | #define CCM_SPCTL0_PD_OFFSET 26 | ||
92 | #define CCM_SPCTL0_PD_MASK (0xf << 26) | ||
93 | #define CCM_SPCTL0_MFD_OFFSET 16 | ||
94 | #define CCM_SPCTL0_MFD_MASK (0x3ff << 16) | ||
95 | #define CCM_SPCTL0_MFI_OFFSET 10 | ||
96 | #define CCM_SPCTL0_MFI_MASK (0xf << 10) | ||
97 | #define CCM_SPCTL0_MFN_OFFSET 0 | ||
98 | #define CCM_SPCTL0_MFN_MASK 0x3ff | ||
99 | |||
100 | #define CCM_SPCTL1_LF (1 << 15) | ||
101 | #define CCM_SPCTL1_BRMO (1 << 6) | ||
102 | |||
103 | #define CCM_OSC26MCTL_PEAK_OFFSET 16 | ||
104 | #define CCM_OSC26MCTL_PEAK_MASK (0x3 << 16) | ||
105 | #define CCM_OSC26MCTL_AGC_OFFSET 8 | ||
106 | #define CCM_OSC26MCTL_AGC_MASK (0x3f << 8) | ||
107 | #define CCM_OSC26MCTL_ANATEST_OFFSET 0 | ||
108 | #define CCM_OSC26MCTL_ANATEST_MASK 0x3f | ||
109 | |||
110 | #define CCM_PCDR0_SSI2BAUDDIV_OFFSET 26 | ||
111 | #define CCM_PCDR0_SSI2BAUDDIV_MASK (0x3f << 26) | ||
112 | #define CCM_PCDR0_SSI1BAUDDIV_OFFSET 16 | ||
113 | #define CCM_PCDR0_SSI1BAUDDIV_MASK (0x3f << 16) | ||
114 | #define CCM_PCDR0_NFCDIV_OFFSET 12 | ||
115 | #define CCM_PCDR0_NFCDIV_MASK (0xf << 12) | ||
116 | #define CCM_PCDR0_48MDIV_OFFSET 5 | ||
117 | #define CCM_PCDR0_48MDIV_MASK (0x7 << CCM_PCDR0_48MDIV_OFFSET) | ||
118 | #define CCM_PCDR0_FIRIDIV_OFFSET 0 | ||
119 | #define CCM_PCDR0_FIRIDIV_MASK 0x1f | ||
120 | #define CCM_PCDR1_PERDIV4_OFFSET 24 | ||
121 | #define CCM_PCDR1_PERDIV4_MASK (0x3f << 24) | ||
122 | #define CCM_PCDR1_PERDIV3_OFFSET 16 | ||
123 | #define CCM_PCDR1_PERDIV3_MASK (0x3f << 16) | ||
124 | #define CCM_PCDR1_PERDIV2_OFFSET 8 | ||
125 | #define CCM_PCDR1_PERDIV2_MASK (0x3f << 8) | ||
126 | #define CCM_PCDR1_PERDIV1_OFFSET 0 | ||
127 | #define CCM_PCDR1_PERDIV1_MASK 0x3f | ||
128 | |||
129 | #define CCM_PCCR_HCLK_CSI_OFFSET 31 | ||
130 | #define CCM_PCCR_HCLK_CSI_REG CCM_PCCR0 | ||
131 | #define CCM_PCCR_HCLK_DMA_OFFSET 30 | ||
132 | #define CCM_PCCR_HCLK_DMA_REG CCM_PCCR0 | ||
133 | #define CCM_PCCR_HCLK_BROM_OFFSET 28 | ||
134 | #define CCM_PCCR_HCLK_BROM_REG CCM_PCCR0 | ||
135 | #define CCM_PCCR_HCLK_EMMA_OFFSET 27 | ||
136 | #define CCM_PCCR_HCLK_EMMA_REG CCM_PCCR0 | ||
137 | #define CCM_PCCR_HCLK_LCDC_OFFSET 26 | ||
138 | #define CCM_PCCR_HCLK_LCDC_REG CCM_PCCR0 | ||
139 | #define CCM_PCCR_HCLK_SLCDC_OFFSET 25 | ||
140 | #define CCM_PCCR_HCLK_SLCDC_REG CCM_PCCR0 | ||
141 | #define CCM_PCCR_HCLK_USBOTG_OFFSET 24 | ||
142 | #define CCM_PCCR_HCLK_USBOTG_REG CCM_PCCR0 | ||
143 | #define CCM_PCCR_HCLK_BMI_OFFSET 23 | ||
144 | #define CCM_PCCR_BMI_MASK (1 << CCM_PCCR_BMI_MASK) | ||
145 | #define CCM_PCCR_HCLK_BMI_REG CCM_PCCR0 | ||
146 | #define CCM_PCCR_PERCLK4_OFFSET 22 | ||
147 | #define CCM_PCCR_PERCLK4_REG CCM_PCCR0 | ||
148 | #define CCM_PCCR_SLCDC_OFFSET 21 | ||
149 | #define CCM_PCCR_SLCDC_REG CCM_PCCR0 | ||
150 | #define CCM_PCCR_FIRI_BAUD_OFFSET 20 | ||
151 | #define CCM_PCCR_FIRI_BAUD_MASK (1 << CCM_PCCR_FIRI_BAUD_MASK) | ||
152 | #define CCM_PCCR_FIRI_BAUD_REG CCM_PCCR0 | ||
153 | #define CCM_PCCR_NFC_OFFSET 19 | ||
154 | #define CCM_PCCR_NFC_REG CCM_PCCR0 | ||
155 | #define CCM_PCCR_LCDC_OFFSET 18 | ||
156 | #define CCM_PCCR_LCDC_REG CCM_PCCR0 | ||
157 | #define CCM_PCCR_SSI1_BAUD_OFFSET 17 | ||
158 | #define CCM_PCCR_SSI1_BAUD_REG CCM_PCCR0 | ||
159 | #define CCM_PCCR_SSI2_BAUD_OFFSET 16 | ||
160 | #define CCM_PCCR_SSI2_BAUD_REG CCM_PCCR0 | ||
161 | #define CCM_PCCR_EMMA_OFFSET 15 | ||
162 | #define CCM_PCCR_EMMA_REG CCM_PCCR0 | ||
163 | #define CCM_PCCR_USBOTG_OFFSET 14 | ||
164 | #define CCM_PCCR_USBOTG_REG CCM_PCCR0 | ||
165 | #define CCM_PCCR_DMA_OFFSET 13 | ||
166 | #define CCM_PCCR_DMA_REG CCM_PCCR0 | ||
167 | #define CCM_PCCR_I2C1_OFFSET 12 | ||
168 | #define CCM_PCCR_I2C1_REG CCM_PCCR0 | ||
169 | #define CCM_PCCR_GPIO_OFFSET 11 | ||
170 | #define CCM_PCCR_GPIO_REG CCM_PCCR0 | ||
171 | #define CCM_PCCR_SDHC2_OFFSET 10 | ||
172 | #define CCM_PCCR_SDHC2_REG CCM_PCCR0 | ||
173 | #define CCM_PCCR_SDHC1_OFFSET 9 | ||
174 | #define CCM_PCCR_SDHC1_REG CCM_PCCR0 | ||
175 | #define CCM_PCCR_FIRI_OFFSET 8 | ||
176 | #define CCM_PCCR_FIRI_MASK (1 << CCM_PCCR_BAUD_MASK) | ||
177 | #define CCM_PCCR_FIRI_REG CCM_PCCR0 | ||
178 | #define CCM_PCCR_SSI2_IPG_OFFSET 7 | ||
179 | #define CCM_PCCR_SSI2_REG CCM_PCCR0 | ||
180 | #define CCM_PCCR_SSI1_IPG_OFFSET 6 | ||
181 | #define CCM_PCCR_SSI1_REG CCM_PCCR0 | ||
182 | #define CCM_PCCR_CSPI2_OFFSET 5 | ||
183 | #define CCM_PCCR_CSPI2_REG CCM_PCCR0 | ||
184 | #define CCM_PCCR_CSPI1_OFFSET 4 | ||
185 | #define CCM_PCCR_CSPI1_REG CCM_PCCR0 | ||
186 | #define CCM_PCCR_UART4_OFFSET 3 | ||
187 | #define CCM_PCCR_UART4_REG CCM_PCCR0 | ||
188 | #define CCM_PCCR_UART3_OFFSET 2 | ||
189 | #define CCM_PCCR_UART3_REG CCM_PCCR0 | ||
190 | #define CCM_PCCR_UART2_OFFSET 1 | ||
191 | #define CCM_PCCR_UART2_REG CCM_PCCR0 | ||
192 | #define CCM_PCCR_UART1_OFFSET 0 | ||
193 | #define CCM_PCCR_UART1_REG CCM_PCCR0 | ||
194 | |||
195 | #define CCM_PCCR_OWIRE_OFFSET 31 | ||
196 | #define CCM_PCCR_OWIRE_REG CCM_PCCR1 | ||
197 | #define CCM_PCCR_KPP_OFFSET 30 | ||
198 | #define CCM_PCCR_KPP_REG CCM_PCCR1 | ||
199 | #define CCM_PCCR_RTC_OFFSET 29 | ||
200 | #define CCM_PCCR_RTC_REG CCM_PCCR1 | ||
201 | #define CCM_PCCR_PWM_OFFSET 28 | ||
202 | #define CCM_PCCR_PWM_REG CCM_PCCR1 | ||
203 | #define CCM_PCCR_GPT3_OFFSET 27 | ||
204 | #define CCM_PCCR_GPT3_REG CCM_PCCR1 | ||
205 | #define CCM_PCCR_GPT2_OFFSET 26 | ||
206 | #define CCM_PCCR_GPT2_REG CCM_PCCR1 | ||
207 | #define CCM_PCCR_GPT1_OFFSET 25 | ||
208 | #define CCM_PCCR_GPT1_REG CCM_PCCR1 | ||
209 | #define CCM_PCCR_WDT_OFFSET 24 | ||
210 | #define CCM_PCCR_WDT_REG CCM_PCCR1 | ||
211 | #define CCM_PCCR_CSPI3_OFFSET 23 | ||
212 | #define CCM_PCCR_CSPI3_REG CCM_PCCR1 | ||
213 | |||
214 | #define CCM_PCCR_CSPI1_MASK (1 << CCM_PCCR_CSPI1_OFFSET) | ||
215 | #define CCM_PCCR_CSPI2_MASK (1 << CCM_PCCR_CSPI2_OFFSET) | ||
216 | #define CCM_PCCR_CSPI3_MASK (1 << CCM_PCCR_CSPI3_OFFSET) | ||
217 | #define CCM_PCCR_DMA_MASK (1 << CCM_PCCR_DMA_OFFSET) | ||
218 | #define CCM_PCCR_EMMA_MASK (1 << CCM_PCCR_EMMA_OFFSET) | ||
219 | #define CCM_PCCR_GPIO_MASK (1 << CCM_PCCR_GPIO_OFFSET) | ||
220 | #define CCM_PCCR_GPT1_MASK (1 << CCM_PCCR_GPT1_OFFSET) | ||
221 | #define CCM_PCCR_GPT2_MASK (1 << CCM_PCCR_GPT2_OFFSET) | ||
222 | #define CCM_PCCR_GPT3_MASK (1 << CCM_PCCR_GPT3_OFFSET) | ||
223 | #define CCM_PCCR_HCLK_BROM_MASK (1 << CCM_PCCR_HCLK_BROM_OFFSET) | ||
224 | #define CCM_PCCR_HCLK_CSI_MASK (1 << CCM_PCCR_HCLK_CSI_OFFSET) | ||
225 | #define CCM_PCCR_HCLK_DMA_MASK (1 << CCM_PCCR_HCLK_DMA_OFFSET) | ||
226 | #define CCM_PCCR_HCLK_EMMA_MASK (1 << CCM_PCCR_HCLK_EMMA_OFFSET) | ||
227 | #define CCM_PCCR_HCLK_LCDC_MASK (1 << CCM_PCCR_HCLK_LCDC_OFFSET) | ||
228 | #define CCM_PCCR_HCLK_SLCDC_MASK (1 << CCM_PCCR_HCLK_SLCDC_OFFSET) | ||
229 | #define CCM_PCCR_HCLK_USBOTG_MASK (1 << CCM_PCCR_HCLK_USBOTG_OFFSET) | ||
230 | #define CCM_PCCR_I2C1_MASK (1 << CCM_PCCR_I2C1_OFFSET) | ||
231 | #define CCM_PCCR_KPP_MASK (1 << CCM_PCCR_KPP_OFFSET) | ||
232 | #define CCM_PCCR_LCDC_MASK (1 << CCM_PCCR_LCDC_OFFSET) | ||
233 | #define CCM_PCCR_NFC_MASK (1 << CCM_PCCR_NFC_OFFSET) | ||
234 | #define CCM_PCCR_OWIRE_MASK (1 << CCM_PCCR_OWIRE_OFFSET) | ||
235 | #define CCM_PCCR_PERCLK4_MASK (1 << CCM_PCCR_PERCLK4_OFFSET) | ||
236 | #define CCM_PCCR_PWM_MASK (1 << CCM_PCCR_PWM_OFFSET) | ||
237 | #define CCM_PCCR_RTC_MASK (1 << CCM_PCCR_RTC_OFFSET) | ||
238 | #define CCM_PCCR_SDHC1_MASK (1 << CCM_PCCR_SDHC1_OFFSET) | ||
239 | #define CCM_PCCR_SDHC2_MASK (1 << CCM_PCCR_SDHC2_OFFSET) | ||
240 | #define CCM_PCCR_SLCDC_MASK (1 << CCM_PCCR_SLCDC_OFFSET) | ||
241 | #define CCM_PCCR_SSI1_BAUD_MASK (1 << CCM_PCCR_SSI1_BAUD_OFFSET) | ||
242 | #define CCM_PCCR_SSI1_IPG_MASK (1 << CCM_PCCR_SSI1_IPG_OFFSET) | ||
243 | #define CCM_PCCR_SSI2_BAUD_MASK (1 << CCM_PCCR_SSI2_BAUD_OFFSET) | ||
244 | #define CCM_PCCR_SSI2_IPG_MASK (1 << CCM_PCCR_SSI2_IPG_OFFSET) | ||
245 | #define CCM_PCCR_UART1_MASK (1 << CCM_PCCR_UART1_OFFSET) | ||
246 | #define CCM_PCCR_UART2_MASK (1 << CCM_PCCR_UART2_OFFSET) | ||
247 | #define CCM_PCCR_UART3_MASK (1 << CCM_PCCR_UART3_OFFSET) | ||
248 | #define CCM_PCCR_UART4_MASK (1 << CCM_PCCR_UART4_OFFSET) | ||
249 | #define CCM_PCCR_USBOTG_MASK (1 << CCM_PCCR_USBOTG_OFFSET) | ||
250 | #define CCM_PCCR_WDT_MASK (1 << CCM_PCCR_WDT_OFFSET) | ||
251 | |||
252 | #define CCM_CCSR_32KSR (1 << 15) | ||
253 | |||
254 | #define CCM_CCSR_CLKMODE1 (1 << 9) | ||
255 | #define CCM_CCSR_CLKMODE0 (1 << 8) | ||
256 | |||
257 | #define CCM_CCSR_CLKOSEL_OFFSET 0 | ||
258 | #define CCM_CCSR_CLKOSEL_MASK 0x1f | ||
259 | |||
260 | #define SYS_FMCR 0x14 /* Functional Muxing Control Reg */ | ||
261 | #define SYS_CHIP_ID 0x00 /* The offset of CHIP ID register */ | ||
262 | |||
263 | static int _clk_enable(struct clk *clk) | ||
264 | { | ||
265 | u32 reg; | ||
266 | |||
267 | reg = __raw_readl(clk->enable_reg); | ||
268 | reg |= 1 << clk->enable_shift; | ||
269 | __raw_writel(reg, clk->enable_reg); | ||
270 | return 0; | ||
271 | } | ||
272 | |||
273 | static void _clk_disable(struct clk *clk) | ||
274 | { | ||
275 | u32 reg; | ||
276 | |||
277 | reg = __raw_readl(clk->enable_reg); | ||
278 | reg &= ~(1 << clk->enable_shift); | ||
279 | __raw_writel(reg, clk->enable_reg); | ||
280 | } | ||
281 | |||
282 | static unsigned long _clk_generic_round_rate(struct clk *clk, | ||
283 | unsigned long rate, | ||
284 | u32 max_divisor) | ||
285 | { | ||
286 | u32 div; | ||
287 | unsigned long parent_rate; | ||
288 | |||
289 | parent_rate = clk_get_rate(clk->parent); | ||
290 | |||
291 | div = parent_rate / rate; | ||
292 | if (parent_rate % rate) | ||
293 | div++; | ||
294 | |||
295 | if (div > max_divisor) | ||
296 | div = max_divisor; | ||
297 | |||
298 | return parent_rate / div; | ||
299 | } | ||
300 | |||
301 | static int _clk_spll_enable(struct clk *clk) | ||
302 | { | ||
303 | u32 reg; | ||
304 | |||
305 | reg = __raw_readl(CCM_CSCR); | ||
306 | reg |= CCM_CSCR_SPEN; | ||
307 | __raw_writel(reg, CCM_CSCR); | ||
308 | |||
309 | while ((__raw_readl(CCM_SPCTL1) & CCM_SPCTL1_LF) == 0) | ||
310 | ; | ||
311 | return 0; | ||
312 | } | ||
313 | |||
314 | static void _clk_spll_disable(struct clk *clk) | ||
315 | { | ||
316 | u32 reg; | ||
317 | |||
318 | reg = __raw_readl(CCM_CSCR); | ||
319 | reg &= ~CCM_CSCR_SPEN; | ||
320 | __raw_writel(reg, CCM_CSCR); | ||
321 | } | ||
322 | |||
323 | |||
324 | #define CSCR() (__raw_readl(CCM_CSCR)) | ||
325 | #define PCDR0() (__raw_readl(CCM_PCDR0)) | ||
326 | #define PCDR1() (__raw_readl(CCM_PCDR1)) | ||
327 | |||
328 | static unsigned long _clk_perclkx_round_rate(struct clk *clk, | ||
329 | unsigned long rate) | ||
330 | { | ||
331 | return _clk_generic_round_rate(clk, rate, 64); | ||
332 | } | ||
333 | |||
334 | static int _clk_perclkx_set_rate(struct clk *clk, unsigned long rate) | ||
335 | { | ||
336 | u32 reg; | ||
337 | u32 div; | ||
338 | unsigned long parent_rate; | ||
339 | |||
340 | parent_rate = clk_get_rate(clk->parent); | ||
341 | |||
342 | if (clk->id < 0 || clk->id > 3) | ||
343 | return -EINVAL; | ||
344 | |||
345 | div = parent_rate / rate; | ||
346 | if (div > 64 || div < 1 || ((parent_rate / div) != rate)) | ||
347 | return -EINVAL; | ||
348 | div--; | ||
349 | |||
350 | reg = | ||
351 | __raw_readl(CCM_PCDR1) & ~(CCM_PCDR1_PERDIV1_MASK << | ||
352 | (clk->id << 3)); | ||
353 | reg |= div << (clk->id << 3); | ||
354 | __raw_writel(reg, CCM_PCDR1); | ||
355 | |||
356 | return 0; | ||
357 | } | ||
358 | |||
359 | static unsigned long _clk_usb_recalc(struct clk *clk) | ||
360 | { | ||
361 | unsigned long usb_pdf; | ||
362 | unsigned long parent_rate; | ||
363 | |||
364 | parent_rate = clk_get_rate(clk->parent); | ||
365 | |||
366 | usb_pdf = (CSCR() & CCM_CSCR_USB_MASK) >> CCM_CSCR_USB_OFFSET; | ||
367 | |||
368 | return parent_rate / (usb_pdf + 1U); | ||
369 | } | ||
370 | |||
371 | static unsigned long _clk_usb_round_rate(struct clk *clk, | ||
372 | unsigned long rate) | ||
373 | { | ||
374 | return _clk_generic_round_rate(clk, rate, 8); | ||
375 | } | ||
376 | |||
377 | static int _clk_usb_set_rate(struct clk *clk, unsigned long rate) | ||
378 | { | ||
379 | u32 reg; | ||
380 | u32 div; | ||
381 | unsigned long parent_rate; | ||
382 | |||
383 | parent_rate = clk_get_rate(clk->parent); | ||
384 | |||
385 | div = parent_rate / rate; | ||
386 | if (div > 8 || div < 1 || ((parent_rate / div) != rate)) | ||
387 | return -EINVAL; | ||
388 | div--; | ||
389 | |||
390 | reg = CSCR() & ~CCM_CSCR_USB_MASK; | ||
391 | reg |= div << CCM_CSCR_USB_OFFSET; | ||
392 | __raw_writel(reg, CCM_CSCR); | ||
393 | |||
394 | return 0; | ||
395 | } | ||
396 | |||
397 | static unsigned long _clk_ssix_recalc(struct clk *clk, unsigned long pdf) | ||
398 | { | ||
399 | unsigned long parent_rate; | ||
400 | |||
401 | parent_rate = clk_get_rate(clk->parent); | ||
402 | |||
403 | pdf = (pdf < 2) ? 124UL : pdf; /* MX21 & MX27 TO1 */ | ||
404 | |||
405 | return 2UL * parent_rate / pdf; | ||
406 | } | ||
407 | |||
408 | static unsigned long _clk_ssi1_recalc(struct clk *clk) | ||
409 | { | ||
410 | return _clk_ssix_recalc(clk, | ||
411 | (PCDR0() & CCM_PCDR0_SSI1BAUDDIV_MASK) | ||
412 | >> CCM_PCDR0_SSI1BAUDDIV_OFFSET); | ||
413 | } | ||
414 | |||
415 | static unsigned long _clk_ssi2_recalc(struct clk *clk) | ||
416 | { | ||
417 | return _clk_ssix_recalc(clk, | ||
418 | (PCDR0() & CCM_PCDR0_SSI2BAUDDIV_MASK) >> | ||
419 | CCM_PCDR0_SSI2BAUDDIV_OFFSET); | ||
420 | } | ||
421 | |||
422 | static unsigned long _clk_nfc_recalc(struct clk *clk) | ||
423 | { | ||
424 | unsigned long nfc_pdf; | ||
425 | unsigned long parent_rate; | ||
426 | |||
427 | parent_rate = clk_get_rate(clk->parent); | ||
428 | |||
429 | nfc_pdf = (PCDR0() & CCM_PCDR0_NFCDIV_MASK) | ||
430 | >> CCM_PCDR0_NFCDIV_OFFSET; | ||
431 | |||
432 | return parent_rate / (nfc_pdf + 1); | ||
433 | } | ||
434 | |||
435 | static unsigned long _clk_parent_round_rate(struct clk *clk, unsigned long rate) | ||
436 | { | ||
437 | return clk->parent->round_rate(clk->parent, rate); | ||
438 | } | ||
439 | |||
440 | static int _clk_parent_set_rate(struct clk *clk, unsigned long rate) | ||
441 | { | ||
442 | return clk->parent->set_rate(clk->parent, rate); | ||
443 | } | ||
444 | |||
445 | static unsigned long external_high_reference; /* in Hz */ | ||
446 | |||
447 | static unsigned long get_high_reference_clock_rate(struct clk *clk) | ||
448 | { | ||
449 | return external_high_reference; | ||
450 | } | ||
451 | |||
452 | /* | ||
453 | * the high frequency external clock reference | ||
454 | * Default case is 26MHz. | ||
455 | */ | ||
456 | static struct clk ckih_clk = { | ||
457 | .get_rate = get_high_reference_clock_rate, | ||
458 | }; | ||
459 | |||
460 | static unsigned long external_low_reference; /* in Hz */ | ||
461 | |||
462 | static unsigned long get_low_reference_clock_rate(struct clk *clk) | ||
463 | { | ||
464 | return external_low_reference; | ||
465 | } | ||
466 | |||
467 | /* | ||
468 | * the low frequency external clock reference | ||
469 | * Default case is 32.768kHz. | ||
470 | */ | ||
471 | static struct clk ckil_clk = { | ||
472 | .get_rate = get_low_reference_clock_rate, | ||
473 | }; | ||
474 | |||
475 | |||
476 | static unsigned long _clk_fpm_recalc(struct clk *clk) | ||
477 | { | ||
478 | return clk_get_rate(clk->parent) * 512; | ||
479 | } | ||
480 | |||
481 | /* Output of frequency pre multiplier */ | ||
482 | static struct clk fpm_clk = { | ||
483 | .parent = &ckil_clk, | ||
484 | .get_rate = _clk_fpm_recalc, | ||
485 | }; | ||
486 | |||
487 | static unsigned long get_mpll_clk(struct clk *clk) | ||
488 | { | ||
489 | uint32_t reg; | ||
490 | unsigned long ref_clk; | ||
491 | unsigned long mfi = 0, mfn = 0, mfd = 0, pdf = 0; | ||
492 | unsigned long long temp; | ||
493 | |||
494 | ref_clk = clk_get_rate(clk->parent); | ||
495 | |||
496 | reg = __raw_readl(CCM_MPCTL0); | ||
497 | pdf = (reg & CCM_MPCTL0_PD_MASK) >> CCM_MPCTL0_PD_OFFSET; | ||
498 | mfd = (reg & CCM_MPCTL0_MFD_MASK) >> CCM_MPCTL0_MFD_OFFSET; | ||
499 | mfi = (reg & CCM_MPCTL0_MFI_MASK) >> CCM_MPCTL0_MFI_OFFSET; | ||
500 | mfn = (reg & CCM_MPCTL0_MFN_MASK) >> CCM_MPCTL0_MFN_OFFSET; | ||
501 | |||
502 | mfi = (mfi <= 5) ? 5 : mfi; | ||
503 | temp = 2LL * ref_clk * mfn; | ||
504 | do_div(temp, mfd + 1); | ||
505 | temp = 2LL * ref_clk * mfi + temp; | ||
506 | do_div(temp, pdf + 1); | ||
507 | |||
508 | return (unsigned long)temp; | ||
509 | } | ||
510 | |||
511 | static struct clk mpll_clk = { | ||
512 | .parent = &ckih_clk, | ||
513 | .get_rate = get_mpll_clk, | ||
514 | }; | ||
515 | |||
516 | static unsigned long _clk_fclk_get_rate(struct clk *clk) | ||
517 | { | ||
518 | unsigned long parent_rate; | ||
519 | u32 div; | ||
520 | |||
521 | div = (CSCR() & CCM_CSCR_PRESC_MASK) >> CCM_CSCR_PRESC_OFFSET; | ||
522 | parent_rate = clk_get_rate(clk->parent); | ||
523 | |||
524 | return parent_rate / (div+1); | ||
525 | } | ||
526 | |||
527 | static struct clk fclk_clk = { | ||
528 | .parent = &mpll_clk, | ||
529 | .get_rate = _clk_fclk_get_rate | ||
530 | }; | ||
531 | |||
532 | static unsigned long get_spll_clk(struct clk *clk) | ||
533 | { | ||
534 | uint32_t reg; | ||
535 | unsigned long ref_clk; | ||
536 | unsigned long mfi = 0, mfn = 0, mfd = 0, pdf = 0; | ||
537 | unsigned long long temp; | ||
538 | |||
539 | ref_clk = clk_get_rate(clk->parent); | ||
540 | |||
541 | reg = __raw_readl(CCM_SPCTL0); | ||
542 | pdf = (reg & CCM_SPCTL0_PD_MASK) >> CCM_SPCTL0_PD_OFFSET; | ||
543 | mfd = (reg & CCM_SPCTL0_MFD_MASK) >> CCM_SPCTL0_MFD_OFFSET; | ||
544 | mfi = (reg & CCM_SPCTL0_MFI_MASK) >> CCM_SPCTL0_MFI_OFFSET; | ||
545 | mfn = (reg & CCM_SPCTL0_MFN_MASK) >> CCM_SPCTL0_MFN_OFFSET; | ||
546 | |||
547 | mfi = (mfi <= 5) ? 5 : mfi; | ||
548 | temp = 2LL * ref_clk * mfn; | ||
549 | do_div(temp, mfd + 1); | ||
550 | temp = 2LL * ref_clk * mfi + temp; | ||
551 | do_div(temp, pdf + 1); | ||
552 | |||
553 | return (unsigned long)temp; | ||
554 | } | ||
555 | |||
556 | static struct clk spll_clk = { | ||
557 | .parent = &ckih_clk, | ||
558 | .get_rate = get_spll_clk, | ||
559 | .enable = _clk_spll_enable, | ||
560 | .disable = _clk_spll_disable, | ||
561 | }; | ||
562 | |||
563 | static unsigned long get_hclk_clk(struct clk *clk) | ||
564 | { | ||
565 | unsigned long rate; | ||
566 | unsigned long bclk_pdf; | ||
567 | |||
568 | bclk_pdf = (CSCR() & CCM_CSCR_BCLK_MASK) | ||
569 | >> CCM_CSCR_BCLK_OFFSET; | ||
570 | |||
571 | rate = clk_get_rate(clk->parent); | ||
572 | return rate / (bclk_pdf + 1); | ||
573 | } | ||
574 | |||
575 | static struct clk hclk_clk = { | ||
576 | .parent = &fclk_clk, | ||
577 | .get_rate = get_hclk_clk, | ||
578 | }; | ||
579 | |||
580 | static unsigned long get_ipg_clk(struct clk *clk) | ||
581 | { | ||
582 | unsigned long rate; | ||
583 | unsigned long ipg_pdf; | ||
584 | |||
585 | ipg_pdf = (CSCR() & CCM_CSCR_IPDIV) >> CCM_CSCR_IPDIV_OFFSET; | ||
586 | |||
587 | rate = clk_get_rate(clk->parent); | ||
588 | return rate / (ipg_pdf + 1); | ||
589 | } | ||
590 | |||
591 | static struct clk ipg_clk = { | ||
592 | .parent = &hclk_clk, | ||
593 | .get_rate = get_ipg_clk, | ||
594 | }; | ||
595 | |||
596 | static unsigned long _clk_perclkx_recalc(struct clk *clk) | ||
597 | { | ||
598 | unsigned long perclk_pdf; | ||
599 | unsigned long parent_rate; | ||
600 | |||
601 | parent_rate = clk_get_rate(clk->parent); | ||
602 | |||
603 | if (clk->id < 0 || clk->id > 3) | ||
604 | return 0; | ||
605 | |||
606 | perclk_pdf = (PCDR1() >> (clk->id << 3)) & CCM_PCDR1_PERDIV1_MASK; | ||
607 | |||
608 | return parent_rate / (perclk_pdf + 1); | ||
609 | } | ||
610 | |||
611 | static struct clk per_clk[] = { | ||
612 | { | ||
613 | .id = 0, | ||
614 | .parent = &mpll_clk, | ||
615 | .get_rate = _clk_perclkx_recalc, | ||
616 | }, { | ||
617 | .id = 1, | ||
618 | .parent = &mpll_clk, | ||
619 | .get_rate = _clk_perclkx_recalc, | ||
620 | }, { | ||
621 | .id = 2, | ||
622 | .parent = &mpll_clk, | ||
623 | .round_rate = _clk_perclkx_round_rate, | ||
624 | .set_rate = _clk_perclkx_set_rate, | ||
625 | .get_rate = _clk_perclkx_recalc, | ||
626 | /* Enable/Disable done via lcd_clkc[1] */ | ||
627 | }, { | ||
628 | .id = 3, | ||
629 | .parent = &mpll_clk, | ||
630 | .round_rate = _clk_perclkx_round_rate, | ||
631 | .set_rate = _clk_perclkx_set_rate, | ||
632 | .get_rate = _clk_perclkx_recalc, | ||
633 | /* Enable/Disable done via csi_clk[1] */ | ||
634 | }, | ||
635 | }; | ||
636 | |||
637 | static struct clk uart_ipg_clk[]; | ||
638 | |||
639 | static struct clk uart_clk[] = { | ||
640 | { | ||
641 | .id = 0, | ||
642 | .parent = &per_clk[0], | ||
643 | .secondary = &uart_ipg_clk[0], | ||
644 | }, { | ||
645 | .id = 1, | ||
646 | .parent = &per_clk[0], | ||
647 | .secondary = &uart_ipg_clk[1], | ||
648 | }, { | ||
649 | .id = 2, | ||
650 | .parent = &per_clk[0], | ||
651 | .secondary = &uart_ipg_clk[2], | ||
652 | }, { | ||
653 | .id = 3, | ||
654 | .parent = &per_clk[0], | ||
655 | .secondary = &uart_ipg_clk[3], | ||
656 | }, | ||
657 | }; | ||
658 | |||
659 | static struct clk uart_ipg_clk[] = { | ||
660 | { | ||
661 | .id = 0, | ||
662 | .parent = &ipg_clk, | ||
663 | .enable = _clk_enable, | ||
664 | .enable_reg = CCM_PCCR_UART1_REG, | ||
665 | .enable_shift = CCM_PCCR_UART1_OFFSET, | ||
666 | .disable = _clk_disable, | ||
667 | }, { | ||
668 | .id = 1, | ||
669 | .parent = &ipg_clk, | ||
670 | .enable = _clk_enable, | ||
671 | .enable_reg = CCM_PCCR_UART2_REG, | ||
672 | .enable_shift = CCM_PCCR_UART2_OFFSET, | ||
673 | .disable = _clk_disable, | ||
674 | }, { | ||
675 | .id = 2, | ||
676 | .parent = &ipg_clk, | ||
677 | .enable = _clk_enable, | ||
678 | .enable_reg = CCM_PCCR_UART3_REG, | ||
679 | .enable_shift = CCM_PCCR_UART3_OFFSET, | ||
680 | .disable = _clk_disable, | ||
681 | }, { | ||
682 | .id = 3, | ||
683 | .parent = &ipg_clk, | ||
684 | .enable = _clk_enable, | ||
685 | .enable_reg = CCM_PCCR_UART4_REG, | ||
686 | .enable_shift = CCM_PCCR_UART4_OFFSET, | ||
687 | .disable = _clk_disable, | ||
688 | }, | ||
689 | }; | ||
690 | |||
691 | static struct clk gpt_ipg_clk[]; | ||
692 | |||
693 | static struct clk gpt_clk[] = { | ||
694 | { | ||
695 | .id = 0, | ||
696 | .parent = &per_clk[0], | ||
697 | .secondary = &gpt_ipg_clk[0], | ||
698 | }, { | ||
699 | .id = 1, | ||
700 | .parent = &per_clk[0], | ||
701 | .secondary = &gpt_ipg_clk[1], | ||
702 | }, { | ||
703 | .id = 2, | ||
704 | .parent = &per_clk[0], | ||
705 | .secondary = &gpt_ipg_clk[2], | ||
706 | }, | ||
707 | }; | ||
708 | |||
709 | static struct clk gpt_ipg_clk[] = { | ||
710 | { | ||
711 | .id = 0, | ||
712 | .parent = &ipg_clk, | ||
713 | .enable = _clk_enable, | ||
714 | .enable_reg = CCM_PCCR_GPT1_REG, | ||
715 | .enable_shift = CCM_PCCR_GPT1_OFFSET, | ||
716 | .disable = _clk_disable, | ||
717 | }, { | ||
718 | .id = 1, | ||
719 | .parent = &ipg_clk, | ||
720 | .enable = _clk_enable, | ||
721 | .enable_reg = CCM_PCCR_GPT2_REG, | ||
722 | .enable_shift = CCM_PCCR_GPT2_OFFSET, | ||
723 | .disable = _clk_disable, | ||
724 | }, { | ||
725 | .id = 2, | ||
726 | .parent = &ipg_clk, | ||
727 | .enable = _clk_enable, | ||
728 | .enable_reg = CCM_PCCR_GPT3_REG, | ||
729 | .enable_shift = CCM_PCCR_GPT3_OFFSET, | ||
730 | .disable = _clk_disable, | ||
731 | }, | ||
732 | }; | ||
733 | |||
734 | static struct clk pwm_clk[] = { | ||
735 | { | ||
736 | .parent = &per_clk[0], | ||
737 | .secondary = &pwm_clk[1], | ||
738 | }, { | ||
739 | .parent = &ipg_clk, | ||
740 | .enable = _clk_enable, | ||
741 | .enable_reg = CCM_PCCR_PWM_REG, | ||
742 | .enable_shift = CCM_PCCR_PWM_OFFSET, | ||
743 | .disable = _clk_disable, | ||
744 | }, | ||
745 | }; | ||
746 | |||
747 | static struct clk sdhc_ipg_clk[]; | ||
748 | |||
749 | static struct clk sdhc_clk[] = { | ||
750 | { | ||
751 | .id = 0, | ||
752 | .parent = &per_clk[1], | ||
753 | .secondary = &sdhc_ipg_clk[0], | ||
754 | }, { | ||
755 | .id = 1, | ||
756 | .parent = &per_clk[1], | ||
757 | .secondary = &sdhc_ipg_clk[1], | ||
758 | }, | ||
759 | }; | ||
760 | |||
761 | static struct clk sdhc_ipg_clk[] = { | ||
762 | { | ||
763 | .id = 0, | ||
764 | .parent = &ipg_clk, | ||
765 | .enable = _clk_enable, | ||
766 | .enable_reg = CCM_PCCR_SDHC1_REG, | ||
767 | .enable_shift = CCM_PCCR_SDHC1_OFFSET, | ||
768 | .disable = _clk_disable, | ||
769 | }, { | ||
770 | .id = 1, | ||
771 | .parent = &ipg_clk, | ||
772 | .enable = _clk_enable, | ||
773 | .enable_reg = CCM_PCCR_SDHC2_REG, | ||
774 | .enable_shift = CCM_PCCR_SDHC2_OFFSET, | ||
775 | .disable = _clk_disable, | ||
776 | }, | ||
777 | }; | ||
778 | |||
779 | static struct clk cspi_ipg_clk[]; | ||
780 | |||
781 | static struct clk cspi_clk[] = { | ||
782 | { | ||
783 | .id = 0, | ||
784 | .parent = &per_clk[1], | ||
785 | .secondary = &cspi_ipg_clk[0], | ||
786 | }, { | ||
787 | .id = 1, | ||
788 | .parent = &per_clk[1], | ||
789 | .secondary = &cspi_ipg_clk[1], | ||
790 | }, { | ||
791 | .id = 2, | ||
792 | .parent = &per_clk[1], | ||
793 | .secondary = &cspi_ipg_clk[2], | ||
794 | }, | ||
795 | }; | ||
796 | |||
797 | static struct clk cspi_ipg_clk[] = { | ||
798 | { | ||
799 | .id = 0, | ||
800 | .parent = &ipg_clk, | ||
801 | .enable = _clk_enable, | ||
802 | .enable_reg = CCM_PCCR_CSPI1_REG, | ||
803 | .enable_shift = CCM_PCCR_CSPI1_OFFSET, | ||
804 | .disable = _clk_disable, | ||
805 | }, { | ||
806 | .id = 1, | ||
807 | .parent = &ipg_clk, | ||
808 | .enable = _clk_enable, | ||
809 | .enable_reg = CCM_PCCR_CSPI2_REG, | ||
810 | .enable_shift = CCM_PCCR_CSPI2_OFFSET, | ||
811 | .disable = _clk_disable, | ||
812 | }, { | ||
813 | .id = 3, | ||
814 | .parent = &ipg_clk, | ||
815 | .enable = _clk_enable, | ||
816 | .enable_reg = CCM_PCCR_CSPI3_REG, | ||
817 | .enable_shift = CCM_PCCR_CSPI3_OFFSET, | ||
818 | .disable = _clk_disable, | ||
819 | }, | ||
820 | }; | ||
821 | |||
822 | static struct clk lcdc_clk[] = { | ||
823 | { | ||
824 | .parent = &per_clk[2], | ||
825 | .secondary = &lcdc_clk[1], | ||
826 | .round_rate = _clk_parent_round_rate, | ||
827 | .set_rate = _clk_parent_set_rate, | ||
828 | }, { | ||
829 | .parent = &ipg_clk, | ||
830 | .secondary = &lcdc_clk[2], | ||
831 | .enable = _clk_enable, | ||
832 | .enable_reg = CCM_PCCR_LCDC_REG, | ||
833 | .enable_shift = CCM_PCCR_LCDC_OFFSET, | ||
834 | .disable = _clk_disable, | ||
835 | }, { | ||
836 | .parent = &hclk_clk, | ||
837 | .enable = _clk_enable, | ||
838 | .enable_reg = CCM_PCCR_HCLK_LCDC_REG, | ||
839 | .enable_shift = CCM_PCCR_HCLK_LCDC_OFFSET, | ||
840 | .disable = _clk_disable, | ||
841 | }, | ||
842 | }; | ||
843 | |||
844 | static struct clk csi_clk[] = { | ||
845 | { | ||
846 | .parent = &per_clk[3], | ||
847 | .secondary = &csi_clk[1], | ||
848 | .round_rate = _clk_parent_round_rate, | ||
849 | .set_rate = _clk_parent_set_rate, | ||
850 | }, { | ||
851 | .parent = &hclk_clk, | ||
852 | .enable = _clk_enable, | ||
853 | .enable_reg = CCM_PCCR_HCLK_CSI_REG, | ||
854 | .enable_shift = CCM_PCCR_HCLK_CSI_OFFSET, | ||
855 | .disable = _clk_disable, | ||
856 | }, | ||
857 | }; | ||
858 | |||
859 | static struct clk usb_clk[] = { | ||
860 | { | ||
861 | .parent = &spll_clk, | ||
862 | .secondary = &usb_clk[1], | ||
863 | .get_rate = _clk_usb_recalc, | ||
864 | .enable = _clk_enable, | ||
865 | .enable_reg = CCM_PCCR_USBOTG_REG, | ||
866 | .enable_shift = CCM_PCCR_USBOTG_OFFSET, | ||
867 | .disable = _clk_disable, | ||
868 | .round_rate = _clk_usb_round_rate, | ||
869 | .set_rate = _clk_usb_set_rate, | ||
870 | }, { | ||
871 | .parent = &hclk_clk, | ||
872 | .enable = _clk_enable, | ||
873 | .enable_reg = CCM_PCCR_HCLK_USBOTG_REG, | ||
874 | .enable_shift = CCM_PCCR_HCLK_USBOTG_OFFSET, | ||
875 | .disable = _clk_disable, | ||
876 | } | ||
877 | }; | ||
878 | |||
879 | static struct clk ssi_ipg_clk[]; | ||
880 | |||
881 | static struct clk ssi_clk[] = { | ||
882 | { | ||
883 | .id = 0, | ||
884 | .parent = &mpll_clk, | ||
885 | .secondary = &ssi_ipg_clk[0], | ||
886 | .get_rate = _clk_ssi1_recalc, | ||
887 | .enable = _clk_enable, | ||
888 | .enable_reg = CCM_PCCR_SSI1_BAUD_REG, | ||
889 | .enable_shift = CCM_PCCR_SSI1_BAUD_OFFSET, | ||
890 | .disable = _clk_disable, | ||
891 | }, { | ||
892 | .id = 1, | ||
893 | .parent = &mpll_clk, | ||
894 | .secondary = &ssi_ipg_clk[1], | ||
895 | .get_rate = _clk_ssi2_recalc, | ||
896 | .enable = _clk_enable, | ||
897 | .enable_reg = CCM_PCCR_SSI2_BAUD_REG, | ||
898 | .enable_shift = CCM_PCCR_SSI2_BAUD_OFFSET, | ||
899 | .disable = _clk_disable, | ||
900 | }, | ||
901 | }; | ||
902 | |||
903 | static struct clk ssi_ipg_clk[] = { | ||
904 | { | ||
905 | .id = 0, | ||
906 | .parent = &ipg_clk, | ||
907 | .enable = _clk_enable, | ||
908 | .enable_reg = CCM_PCCR_SSI1_REG, | ||
909 | .enable_shift = CCM_PCCR_SSI1_IPG_OFFSET, | ||
910 | .disable = _clk_disable, | ||
911 | }, { | ||
912 | .id = 1, | ||
913 | .parent = &ipg_clk, | ||
914 | .enable = _clk_enable, | ||
915 | .enable_reg = CCM_PCCR_SSI2_REG, | ||
916 | .enable_shift = CCM_PCCR_SSI2_IPG_OFFSET, | ||
917 | .disable = _clk_disable, | ||
918 | }, | ||
919 | }; | ||
920 | |||
921 | |||
922 | static struct clk nfc_clk = { | ||
923 | .parent = &fclk_clk, | ||
924 | .get_rate = _clk_nfc_recalc, | ||
925 | .enable = _clk_enable, | ||
926 | .enable_reg = CCM_PCCR_NFC_REG, | ||
927 | .enable_shift = CCM_PCCR_NFC_OFFSET, | ||
928 | .disable = _clk_disable, | ||
929 | }; | ||
930 | |||
931 | static struct clk dma_clk[] = { | ||
932 | { | ||
933 | .parent = &hclk_clk, | ||
934 | .enable = _clk_enable, | ||
935 | .enable_reg = CCM_PCCR_DMA_REG, | ||
936 | .enable_shift = CCM_PCCR_DMA_OFFSET, | ||
937 | .disable = _clk_disable, | ||
938 | .secondary = &dma_clk[1], | ||
939 | }, { | ||
940 | .enable = _clk_enable, | ||
941 | .enable_reg = CCM_PCCR_HCLK_DMA_REG, | ||
942 | .enable_shift = CCM_PCCR_HCLK_DMA_OFFSET, | ||
943 | .disable = _clk_disable, | ||
944 | }, | ||
945 | }; | ||
946 | |||
947 | static struct clk brom_clk = { | ||
948 | .parent = &hclk_clk, | ||
949 | .enable = _clk_enable, | ||
950 | .enable_reg = CCM_PCCR_HCLK_BROM_REG, | ||
951 | .enable_shift = CCM_PCCR_HCLK_BROM_OFFSET, | ||
952 | .disable = _clk_disable, | ||
953 | }; | ||
954 | |||
955 | static struct clk emma_clk[] = { | ||
956 | { | ||
957 | .parent = &hclk_clk, | ||
958 | .enable = _clk_enable, | ||
959 | .enable_reg = CCM_PCCR_EMMA_REG, | ||
960 | .enable_shift = CCM_PCCR_EMMA_OFFSET, | ||
961 | .disable = _clk_disable, | ||
962 | .secondary = &emma_clk[1], | ||
963 | }, { | ||
964 | .enable = _clk_enable, | ||
965 | .enable_reg = CCM_PCCR_HCLK_EMMA_REG, | ||
966 | .enable_shift = CCM_PCCR_HCLK_EMMA_OFFSET, | ||
967 | .disable = _clk_disable, | ||
968 | } | ||
969 | }; | ||
970 | |||
971 | static struct clk slcdc_clk[] = { | ||
972 | { | ||
973 | .parent = &hclk_clk, | ||
974 | .enable = _clk_enable, | ||
975 | .enable_reg = CCM_PCCR_SLCDC_REG, | ||
976 | .enable_shift = CCM_PCCR_SLCDC_OFFSET, | ||
977 | .disable = _clk_disable, | ||
978 | .secondary = &slcdc_clk[1], | ||
979 | }, { | ||
980 | .enable = _clk_enable, | ||
981 | .enable_reg = CCM_PCCR_HCLK_SLCDC_REG, | ||
982 | .enable_shift = CCM_PCCR_HCLK_SLCDC_OFFSET, | ||
983 | .disable = _clk_disable, | ||
984 | } | ||
985 | }; | ||
986 | |||
987 | static struct clk wdog_clk = { | ||
988 | .parent = &ipg_clk, | ||
989 | .enable = _clk_enable, | ||
990 | .enable_reg = CCM_PCCR_WDT_REG, | ||
991 | .enable_shift = CCM_PCCR_WDT_OFFSET, | ||
992 | .disable = _clk_disable, | ||
993 | }; | ||
994 | |||
995 | static struct clk gpio_clk = { | ||
996 | .parent = &ipg_clk, | ||
997 | .enable = _clk_enable, | ||
998 | .enable_reg = CCM_PCCR_GPIO_REG, | ||
999 | .enable_shift = CCM_PCCR_GPIO_OFFSET, | ||
1000 | .disable = _clk_disable, | ||
1001 | }; | ||
1002 | |||
1003 | static struct clk i2c_clk = { | ||
1004 | .id = 0, | ||
1005 | .parent = &ipg_clk, | ||
1006 | .enable = _clk_enable, | ||
1007 | .enable_reg = CCM_PCCR_I2C1_REG, | ||
1008 | .enable_shift = CCM_PCCR_I2C1_OFFSET, | ||
1009 | .disable = _clk_disable, | ||
1010 | }; | ||
1011 | |||
1012 | static struct clk kpp_clk = { | ||
1013 | .parent = &ipg_clk, | ||
1014 | .enable = _clk_enable, | ||
1015 | .enable_reg = CCM_PCCR_KPP_REG, | ||
1016 | .enable_shift = CCM_PCCR_KPP_OFFSET, | ||
1017 | .disable = _clk_disable, | ||
1018 | }; | ||
1019 | |||
1020 | static struct clk owire_clk = { | ||
1021 | .parent = &ipg_clk, | ||
1022 | .enable = _clk_enable, | ||
1023 | .enable_reg = CCM_PCCR_OWIRE_REG, | ||
1024 | .enable_shift = CCM_PCCR_OWIRE_OFFSET, | ||
1025 | .disable = _clk_disable, | ||
1026 | }; | ||
1027 | |||
1028 | static struct clk rtc_clk = { | ||
1029 | .parent = &ipg_clk, | ||
1030 | .enable = _clk_enable, | ||
1031 | .enable_reg = CCM_PCCR_RTC_REG, | ||
1032 | .enable_shift = CCM_PCCR_RTC_OFFSET, | ||
1033 | .disable = _clk_disable, | ||
1034 | }; | ||
1035 | |||
1036 | static unsigned long _clk_clko_round_rate(struct clk *clk, unsigned long rate) | ||
1037 | { | ||
1038 | return _clk_generic_round_rate(clk, rate, 8); | ||
1039 | } | ||
1040 | |||
1041 | static int _clk_clko_set_rate(struct clk *clk, unsigned long rate) | ||
1042 | { | ||
1043 | u32 reg; | ||
1044 | u32 div; | ||
1045 | unsigned long parent_rate; | ||
1046 | |||
1047 | parent_rate = clk_get_rate(clk->parent); | ||
1048 | |||
1049 | div = parent_rate / rate; | ||
1050 | |||
1051 | if (div > 8 || div < 1 || ((parent_rate / div) != rate)) | ||
1052 | return -EINVAL; | ||
1053 | div--; | ||
1054 | |||
1055 | reg = __raw_readl(CCM_PCDR0); | ||
1056 | |||
1057 | if (clk->parent == &usb_clk[0]) { | ||
1058 | reg &= ~CCM_PCDR0_48MDIV_MASK; | ||
1059 | reg |= div << CCM_PCDR0_48MDIV_OFFSET; | ||
1060 | } | ||
1061 | __raw_writel(reg, CCM_PCDR0); | ||
1062 | |||
1063 | return 0; | ||
1064 | } | ||
1065 | |||
1066 | static unsigned long _clk_clko_recalc(struct clk *clk) | ||
1067 | { | ||
1068 | u32 div = 0; | ||
1069 | unsigned long parent_rate; | ||
1070 | |||
1071 | parent_rate = clk_get_rate(clk->parent); | ||
1072 | |||
1073 | if (clk->parent == &usb_clk[0]) /* 48M */ | ||
1074 | div = __raw_readl(CCM_PCDR0) & CCM_PCDR0_48MDIV_MASK | ||
1075 | >> CCM_PCDR0_48MDIV_OFFSET; | ||
1076 | div++; | ||
1077 | |||
1078 | return parent_rate / div; | ||
1079 | } | ||
1080 | |||
1081 | static struct clk clko_clk; | ||
1082 | |||
1083 | static int _clk_clko_set_parent(struct clk *clk, struct clk *parent) | ||
1084 | { | ||
1085 | u32 reg; | ||
1086 | |||
1087 | reg = __raw_readl(CCM_CCSR) & ~CCM_CCSR_CLKOSEL_MASK; | ||
1088 | |||
1089 | if (parent == &ckil_clk) | ||
1090 | reg |= 0 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1091 | else if (parent == &fpm_clk) | ||
1092 | reg |= 1 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1093 | else if (parent == &ckih_clk) | ||
1094 | reg |= 2 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1095 | else if (parent == mpll_clk.parent) | ||
1096 | reg |= 3 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1097 | else if (parent == spll_clk.parent) | ||
1098 | reg |= 4 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1099 | else if (parent == &mpll_clk) | ||
1100 | reg |= 5 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1101 | else if (parent == &spll_clk) | ||
1102 | reg |= 6 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1103 | else if (parent == &fclk_clk) | ||
1104 | reg |= 7 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1105 | else if (parent == &hclk_clk) | ||
1106 | reg |= 8 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1107 | else if (parent == &ipg_clk) | ||
1108 | reg |= 9 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1109 | else if (parent == &per_clk[0]) | ||
1110 | reg |= 0xA << CCM_CCSR_CLKOSEL_OFFSET; | ||
1111 | else if (parent == &per_clk[1]) | ||
1112 | reg |= 0xB << CCM_CCSR_CLKOSEL_OFFSET; | ||
1113 | else if (parent == &per_clk[2]) | ||
1114 | reg |= 0xC << CCM_CCSR_CLKOSEL_OFFSET; | ||
1115 | else if (parent == &per_clk[3]) | ||
1116 | reg |= 0xD << CCM_CCSR_CLKOSEL_OFFSET; | ||
1117 | else if (parent == &ssi_clk[0]) | ||
1118 | reg |= 0xE << CCM_CCSR_CLKOSEL_OFFSET; | ||
1119 | else if (parent == &ssi_clk[1]) | ||
1120 | reg |= 0xF << CCM_CCSR_CLKOSEL_OFFSET; | ||
1121 | else if (parent == &nfc_clk) | ||
1122 | reg |= 0x10 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1123 | else if (parent == &usb_clk[0]) | ||
1124 | reg |= 0x14 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1125 | else if (parent == &clko_clk) | ||
1126 | reg |= 0x15 << CCM_CCSR_CLKOSEL_OFFSET; | ||
1127 | else | ||
1128 | return -EINVAL; | ||
1129 | |||
1130 | __raw_writel(reg, CCM_CCSR); | ||
1131 | |||
1132 | return 0; | ||
1133 | } | ||
1134 | |||
1135 | static struct clk clko_clk = { | ||
1136 | .get_rate = _clk_clko_recalc, | ||
1137 | .set_rate = _clk_clko_set_rate, | ||
1138 | .round_rate = _clk_clko_round_rate, | ||
1139 | .set_parent = _clk_clko_set_parent, | ||
1140 | }; | ||
1141 | |||
1142 | |||
1143 | #define _REGISTER_CLOCK(d, n, c) \ | ||
1144 | { \ | ||
1145 | .dev_id = d, \ | ||
1146 | .con_id = n, \ | ||
1147 | .clk = &c, \ | ||
1148 | }, | ||
1149 | static struct clk_lookup lookups[] = { | ||
1150 | /* It's unlikely that any driver wants one of them directly: | ||
1151 | _REGISTER_CLOCK(NULL, "ckih", ckih_clk) | ||
1152 | _REGISTER_CLOCK(NULL, "ckil", ckil_clk) | ||
1153 | _REGISTER_CLOCK(NULL, "fpm", fpm_clk) | ||
1154 | _REGISTER_CLOCK(NULL, "mpll", mpll_clk) | ||
1155 | _REGISTER_CLOCK(NULL, "spll", spll_clk) | ||
1156 | _REGISTER_CLOCK(NULL, "fclk", fclk_clk) | ||
1157 | _REGISTER_CLOCK(NULL, "hclk", hclk_clk) | ||
1158 | _REGISTER_CLOCK(NULL, "ipg", ipg_clk) | ||
1159 | */ | ||
1160 | _REGISTER_CLOCK(NULL, "perclk1", per_clk[0]) | ||
1161 | _REGISTER_CLOCK(NULL, "perclk2", per_clk[1]) | ||
1162 | _REGISTER_CLOCK(NULL, "perclk3", per_clk[2]) | ||
1163 | _REGISTER_CLOCK(NULL, "perclk4", per_clk[3]) | ||
1164 | _REGISTER_CLOCK(NULL, "clko", clko_clk) | ||
1165 | _REGISTER_CLOCK("imx21-uart.0", NULL, uart_clk[0]) | ||
1166 | _REGISTER_CLOCK("imx21-uart.1", NULL, uart_clk[1]) | ||
1167 | _REGISTER_CLOCK("imx21-uart.2", NULL, uart_clk[2]) | ||
1168 | _REGISTER_CLOCK("imx21-uart.3", NULL, uart_clk[3]) | ||
1169 | _REGISTER_CLOCK(NULL, "gpt1", gpt_clk[0]) | ||
1170 | _REGISTER_CLOCK(NULL, "gpt1", gpt_clk[1]) | ||
1171 | _REGISTER_CLOCK(NULL, "gpt1", gpt_clk[2]) | ||
1172 | _REGISTER_CLOCK(NULL, "pwm", pwm_clk[0]) | ||
1173 | _REGISTER_CLOCK(NULL, "sdhc1", sdhc_clk[0]) | ||
1174 | _REGISTER_CLOCK(NULL, "sdhc2", sdhc_clk[1]) | ||
1175 | _REGISTER_CLOCK("imx21-cspi.0", NULL, cspi_clk[0]) | ||
1176 | _REGISTER_CLOCK("imx21-cspi.1", NULL, cspi_clk[1]) | ||
1177 | _REGISTER_CLOCK("imx21-cspi.2", NULL, cspi_clk[2]) | ||
1178 | _REGISTER_CLOCK("imx-fb.0", NULL, lcdc_clk[0]) | ||
1179 | _REGISTER_CLOCK(NULL, "csi", csi_clk[0]) | ||
1180 | _REGISTER_CLOCK("imx21-hcd.0", NULL, usb_clk[0]) | ||
1181 | _REGISTER_CLOCK(NULL, "ssi1", ssi_clk[0]) | ||
1182 | _REGISTER_CLOCK(NULL, "ssi2", ssi_clk[1]) | ||
1183 | _REGISTER_CLOCK("mxc_nand.0", NULL, nfc_clk) | ||
1184 | _REGISTER_CLOCK(NULL, "dma", dma_clk[0]) | ||
1185 | _REGISTER_CLOCK(NULL, "brom", brom_clk) | ||
1186 | _REGISTER_CLOCK(NULL, "emma", emma_clk[0]) | ||
1187 | _REGISTER_CLOCK(NULL, "slcdc", slcdc_clk[0]) | ||
1188 | _REGISTER_CLOCK("imx2-wdt.0", NULL, wdog_clk) | ||
1189 | _REGISTER_CLOCK(NULL, "gpio", gpio_clk) | ||
1190 | _REGISTER_CLOCK("imx-i2c.0", NULL, i2c_clk) | ||
1191 | _REGISTER_CLOCK("mxc-keypad", NULL, kpp_clk) | ||
1192 | _REGISTER_CLOCK(NULL, "owire", owire_clk) | ||
1193 | _REGISTER_CLOCK(NULL, "rtc", rtc_clk) | ||
1194 | }; | ||
1195 | |||
1196 | /* | ||
1197 | * must be called very early to get information about the | ||
1198 | * available clock rate when the timer framework starts | ||
1199 | */ | ||
1200 | int __init mx21_clocks_init(unsigned long lref, unsigned long href) | ||
1201 | { | ||
1202 | u32 cscr; | ||
1203 | |||
1204 | external_low_reference = lref; | ||
1205 | external_high_reference = href; | ||
1206 | |||
1207 | /* detect clock reference for both system PLL */ | ||
1208 | cscr = CSCR(); | ||
1209 | if (cscr & CCM_CSCR_MCU) | ||
1210 | mpll_clk.parent = &ckih_clk; | ||
1211 | else | ||
1212 | mpll_clk.parent = &fpm_clk; | ||
1213 | |||
1214 | if (cscr & CCM_CSCR_SP) | ||
1215 | spll_clk.parent = &ckih_clk; | ||
1216 | else | ||
1217 | spll_clk.parent = &fpm_clk; | ||
1218 | |||
1219 | clkdev_add_table(lookups, ARRAY_SIZE(lookups)); | ||
1220 | |||
1221 | /* Turn off all clock gates */ | ||
1222 | __raw_writel(0, CCM_PCCR0); | ||
1223 | __raw_writel(CCM_PCCR_GPT1_MASK, CCM_PCCR1); | ||
1224 | |||
1225 | /* This turns of the serial PLL as well */ | ||
1226 | spll_clk.disable(&spll_clk); | ||
1227 | |||
1228 | /* This will propagate to all children and init all the clock rates. */ | ||
1229 | clk_enable(&per_clk[0]); | ||
1230 | clk_enable(&gpio_clk); | ||
1231 | |||
1232 | #if defined(CONFIG_DEBUG_LL) && !defined(CONFIG_DEBUG_ICEDCC) | ||
1233 | clk_enable(&uart_clk[0]); | ||
1234 | #endif | ||
1235 | |||
1236 | mxc_timer_init(&gpt_clk[0], MX21_IO_ADDRESS(MX21_GPT1_BASE_ADDR), | ||
1237 | MX21_INT_GPT1); | ||
1238 | return 0; | ||
1239 | } | ||
diff --git a/arch/arm/mach-imx/clock-imx25.c b/arch/arm/mach-imx/clock-imx25.c deleted file mode 100644 index b0fec74c8c91..000000000000 --- a/arch/arm/mach-imx/clock-imx25.c +++ /dev/null | |||
@@ -1,346 +0,0 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2009 by Sascha Hauer, Pengutronix | ||
3 | * | ||
4 | * This program is free software; you can redistribute it and/or | ||
5 | * modify it under the terms of the GNU General Public License | ||
6 | * as published by the Free Software Foundation; either version 2 | ||
7 | * of the License, or (at your option) any later version. | ||
8 | * This program is distributed in the hope that it will be useful, | ||
9 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
10 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
11 | * GNU General Public License for more details. | ||
12 | * | ||
13 | * You should have received a copy of the GNU General Public License | ||
14 | * along with this program; if not, write to the Free Software | ||
15 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, | ||
16 | * MA 02110-1301, USA. | ||
17 | */ | ||
18 | |||
19 | #include <linux/kernel.h> | ||
20 | #include <linux/init.h> | ||
21 | #include <linux/list.h> | ||
22 | #include <linux/clk.h> | ||
23 | #include <linux/io.h> | ||
24 | #include <linux/clkdev.h> | ||
25 | |||
26 | #include <mach/clock.h> | ||
27 | #include <mach/hardware.h> | ||
28 | #include <mach/common.h> | ||
29 | #include <mach/mx25.h> | ||
30 | |||
31 | #define CRM_BASE MX25_IO_ADDRESS(MX25_CRM_BASE_ADDR) | ||
32 | |||
33 | #define CCM_MPCTL 0x00 | ||
34 | #define CCM_UPCTL 0x04 | ||
35 | #define CCM_CCTL 0x08 | ||
36 | #define CCM_CGCR0 0x0C | ||
37 | #define CCM_CGCR1 0x10 | ||
38 | #define CCM_CGCR2 0x14 | ||
39 | #define CCM_PCDR0 0x18 | ||
40 | #define CCM_PCDR1 0x1C | ||
41 | #define CCM_PCDR2 0x20 | ||
42 | #define CCM_PCDR3 0x24 | ||
43 | #define CCM_RCSR 0x28 | ||
44 | #define CCM_CRDR 0x2C | ||
45 | #define CCM_DCVR0 0x30 | ||
46 | #define CCM_DCVR1 0x34 | ||
47 | #define CCM_DCVR2 0x38 | ||
48 | #define CCM_DCVR3 0x3c | ||
49 | #define CCM_LTR0 0x40 | ||
50 | #define CCM_LTR1 0x44 | ||
51 | #define CCM_LTR2 0x48 | ||
52 | #define CCM_LTR3 0x4c | ||
53 | |||
54 | static unsigned long get_rate_mpll(void) | ||
55 | { | ||
56 | ulong mpctl = __raw_readl(CRM_BASE + CCM_MPCTL); | ||
57 | |||
58 | return mxc_decode_pll(mpctl, 24000000); | ||
59 | } | ||
60 | |||
61 | static unsigned long get_rate_upll(void) | ||
62 | { | ||
63 | ulong mpctl = __raw_readl(CRM_BASE + CCM_UPCTL); | ||
64 | |||
65 | return mxc_decode_pll(mpctl, 24000000); | ||
66 | } | ||
67 | |||
68 | unsigned long get_rate_arm(struct clk *clk) | ||
69 | { | ||
70 | unsigned long cctl = readl(CRM_BASE + CCM_CCTL); | ||
71 | unsigned long rate = get_rate_mpll(); | ||
72 | |||
73 | if (cctl & (1 << 14)) | ||
74 | rate = (rate * 3) >> 2; | ||
75 | |||
76 | return rate / ((cctl >> 30) + 1); | ||
77 | } | ||
78 | |||
79 | static unsigned long get_rate_ahb(struct clk *clk) | ||
80 | { | ||
81 | unsigned long cctl = readl(CRM_BASE + CCM_CCTL); | ||
82 | |||
83 | return get_rate_arm(NULL) / (((cctl >> 28) & 0x3) + 1); | ||
84 | } | ||
85 | |||
86 | static unsigned long get_rate_ipg(struct clk *clk) | ||
87 | { | ||
88 | return get_rate_ahb(NULL) >> 1; | ||
89 | } | ||
90 | |||
91 | static unsigned long get_rate_per(int per) | ||
92 | { | ||
93 | unsigned long ofs = (per & 0x3) * 8; | ||
94 | unsigned long reg = per & ~0x3; | ||
95 | unsigned long val = (readl(CRM_BASE + CCM_PCDR0 + reg) >> ofs) & 0x3f; | ||
96 | unsigned long fref; | ||
97 | |||
98 | if (readl(CRM_BASE + 0x64) & (1 << per)) | ||
99 | fref = get_rate_upll(); | ||
100 | else | ||
101 | fref = get_rate_ahb(NULL); | ||
102 | |||
103 | return fref / (val + 1); | ||
104 | } | ||
105 | |||
106 | static unsigned long get_rate_uart(struct clk *clk) | ||
107 | { | ||
108 | return get_rate_per(15); | ||
109 | } | ||
110 | |||
111 | static unsigned long get_rate_ssi2(struct clk *clk) | ||
112 | { | ||
113 | return get_rate_per(14); | ||
114 | } | ||
115 | |||
116 | static unsigned long get_rate_ssi1(struct clk *clk) | ||
117 | { | ||
118 | return get_rate_per(13); | ||
119 | } | ||
120 | |||
121 | static unsigned long get_rate_i2c(struct clk *clk) | ||
122 | { | ||
123 | return get_rate_per(6); | ||
124 | } | ||
125 | |||
126 | static unsigned long get_rate_nfc(struct clk *clk) | ||
127 | { | ||
128 | return get_rate_per(8); | ||
129 | } | ||
130 | |||
131 | static unsigned long get_rate_gpt(struct clk *clk) | ||
132 | { | ||
133 | return get_rate_per(5); | ||
134 | } | ||
135 | |||
136 | static unsigned long get_rate_lcdc(struct clk *clk) | ||
137 | { | ||
138 | return get_rate_per(7); | ||
139 | } | ||
140 | |||
141 | static unsigned long get_rate_esdhc1(struct clk *clk) | ||
142 | { | ||
143 | return get_rate_per(3); | ||
144 | } | ||
145 | |||
146 | static unsigned long get_rate_esdhc2(struct clk *clk) | ||
147 | { | ||
148 | return get_rate_per(4); | ||
149 | } | ||
150 | |||
151 | static unsigned long get_rate_csi(struct clk *clk) | ||
152 | { | ||
153 | return get_rate_per(0); | ||
154 | } | ||
155 | |||
156 | static unsigned long get_rate_otg(struct clk *clk) | ||
157 | { | ||
158 | unsigned long cctl = readl(CRM_BASE + CCM_CCTL); | ||
159 | unsigned long rate = get_rate_upll(); | ||
160 | |||
161 | return (cctl & (1 << 23)) ? 0 : rate / ((0x3F & (cctl >> 16)) + 1); | ||
162 | } | ||
163 | |||
164 | static int clk_cgcr_enable(struct clk *clk) | ||
165 | { | ||
166 | u32 reg; | ||
167 | |||
168 | reg = __raw_readl(clk->enable_reg); | ||
169 | reg |= 1 << clk->enable_shift; | ||
170 | __raw_writel(reg, clk->enable_reg); | ||
171 | |||
172 | return 0; | ||
173 | } | ||
174 | |||
175 | static void clk_cgcr_disable(struct clk *clk) | ||
176 | { | ||
177 | u32 reg; | ||
178 | |||
179 | reg = __raw_readl(clk->enable_reg); | ||
180 | reg &= ~(1 << clk->enable_shift); | ||
181 | __raw_writel(reg, clk->enable_reg); | ||
182 | } | ||
183 | |||
184 | #define DEFINE_CLOCK(name, i, er, es, gr, sr, s) \ | ||
185 | static struct clk name = { \ | ||
186 | .id = i, \ | ||
187 | .enable_reg = CRM_BASE + er, \ | ||
188 | .enable_shift = es, \ | ||
189 | .get_rate = gr, \ | ||
190 | .set_rate = sr, \ | ||
191 | .enable = clk_cgcr_enable, \ | ||
192 | .disable = clk_cgcr_disable, \ | ||
193 | .secondary = s, \ | ||
194 | } | ||
195 | |||
196 | /* | ||
197 | * Note: the following IPG clock gating bits are wrongly marked "Reserved" in | ||
198 | * the i.MX25 Reference Manual Rev 1, table 15-13. The information below is | ||
199 | * taken from the Freescale released BSP. | ||
200 | * | ||
201 | * bit reg offset clock | ||
202 | * | ||
203 | * 0 CGCR1 0 AUDMUX | ||
204 | * 12 CGCR1 12 ESAI | ||
205 | * 16 CGCR1 16 GPIO1 | ||
206 | * 17 CGCR1 17 GPIO2 | ||
207 | * 18 CGCR1 18 GPIO3 | ||
208 | * 23 CGCR1 23 I2C1 | ||
209 | * 24 CGCR1 24 I2C2 | ||
210 | * 25 CGCR1 25 I2C3 | ||
211 | * 27 CGCR1 27 IOMUXC | ||
212 | * 28 CGCR1 28 KPP | ||
213 | * 30 CGCR1 30 OWIRE | ||
214 | * 36 CGCR2 4 RTIC | ||
215 | * 51 CGCR2 19 WDOG | ||
216 | */ | ||
217 | |||
218 | DEFINE_CLOCK(gpt_clk, 0, CCM_CGCR0, 5, get_rate_gpt, NULL, NULL); | ||
219 | DEFINE_CLOCK(uart_per_clk, 0, CCM_CGCR0, 15, get_rate_uart, NULL, NULL); | ||
220 | DEFINE_CLOCK(ssi1_per_clk, 0, CCM_CGCR0, 13, get_rate_ipg, NULL, NULL); | ||
221 | DEFINE_CLOCK(ssi2_per_clk, 0, CCM_CGCR0, 14, get_rate_ipg, NULL, NULL); | ||
222 | DEFINE_CLOCK(cspi1_clk, 0, CCM_CGCR1, 5, get_rate_ipg, NULL, NULL); | ||
223 | DEFINE_CLOCK(cspi2_clk, 0, CCM_CGCR1, 6, get_rate_ipg, NULL, NULL); | ||
224 | DEFINE_CLOCK(cspi3_clk, 0, CCM_CGCR1, 7, get_rate_ipg, NULL, NULL); | ||
225 | DEFINE_CLOCK(esdhc1_ahb_clk, 0, CCM_CGCR0, 21, get_rate_esdhc1, NULL, NULL); | ||
226 | DEFINE_CLOCK(esdhc1_per_clk, 0, CCM_CGCR0, 3, get_rate_esdhc1, NULL, | ||
227 | &esdhc1_ahb_clk); | ||
228 | DEFINE_CLOCK(esdhc2_ahb_clk, 0, CCM_CGCR0, 22, get_rate_esdhc2, NULL, NULL); | ||
229 | DEFINE_CLOCK(esdhc2_per_clk, 0, CCM_CGCR0, 4, get_rate_esdhc2, NULL, | ||
230 | &esdhc2_ahb_clk); | ||
231 | DEFINE_CLOCK(sdma_ahb_clk, 0, CCM_CGCR0, 26, NULL, NULL, NULL); | ||
232 | DEFINE_CLOCK(fec_ahb_clk, 0, CCM_CGCR0, 23, NULL, NULL, NULL); | ||
233 | DEFINE_CLOCK(lcdc_ahb_clk, 0, CCM_CGCR0, 24, NULL, NULL, NULL); | ||
234 | DEFINE_CLOCK(lcdc_per_clk, 0, CCM_CGCR0, 7, NULL, NULL, &lcdc_ahb_clk); | ||
235 | DEFINE_CLOCK(csi_ahb_clk, 0, CCM_CGCR0, 18, get_rate_csi, NULL, NULL); | ||
236 | DEFINE_CLOCK(csi_per_clk, 0, CCM_CGCR0, 0, get_rate_csi, NULL, &csi_ahb_clk); | ||
237 | DEFINE_CLOCK(uart1_clk, 0, CCM_CGCR2, 14, get_rate_uart, NULL, &uart_per_clk); | ||
238 | DEFINE_CLOCK(uart2_clk, 0, CCM_CGCR2, 15, get_rate_uart, NULL, &uart_per_clk); | ||
239 | DEFINE_CLOCK(uart3_clk, 0, CCM_CGCR2, 16, get_rate_uart, NULL, &uart_per_clk); | ||
240 | DEFINE_CLOCK(uart4_clk, 0, CCM_CGCR2, 17, get_rate_uart, NULL, &uart_per_clk); | ||
241 | DEFINE_CLOCK(uart5_clk, 0, CCM_CGCR2, 18, get_rate_uart, NULL, &uart_per_clk); | ||
242 | DEFINE_CLOCK(nfc_clk, 0, CCM_CGCR0, 8, get_rate_nfc, NULL, NULL); | ||
243 | DEFINE_CLOCK(usbotg_clk, 0, CCM_CGCR0, 28, get_rate_otg, NULL, NULL); | ||
244 | DEFINE_CLOCK(pwm1_clk, 0, CCM_CGCR1, 31, get_rate_ipg, NULL, NULL); | ||
245 | DEFINE_CLOCK(pwm2_clk, 0, CCM_CGCR2, 0, get_rate_ipg, NULL, NULL); | ||
246 | DEFINE_CLOCK(pwm3_clk, 0, CCM_CGCR2, 1, get_rate_ipg, NULL, NULL); | ||
247 | DEFINE_CLOCK(pwm4_clk, 0, CCM_CGCR2, 2, get_rate_ipg, NULL, NULL); | ||
248 | DEFINE_CLOCK(kpp_clk, 0, CCM_CGCR1, 28, get_rate_ipg, NULL, NULL); | ||
249 | DEFINE_CLOCK(tsc_clk, 0, CCM_CGCR2, 13, get_rate_ipg, NULL, NULL); | ||
250 | DEFINE_CLOCK(i2c_clk, 0, CCM_CGCR0, 6, get_rate_i2c, NULL, NULL); | ||
251 | DEFINE_CLOCK(fec_clk, 0, CCM_CGCR1, 15, get_rate_ipg, NULL, &fec_ahb_clk); | ||
252 | DEFINE_CLOCK(dryice_clk, 0, CCM_CGCR1, 8, get_rate_ipg, NULL, NULL); | ||
253 | DEFINE_CLOCK(lcdc_clk, 0, CCM_CGCR1, 29, get_rate_lcdc, NULL, &lcdc_per_clk); | ||
254 | DEFINE_CLOCK(wdt_clk, 0, CCM_CGCR2, 19, get_rate_ipg, NULL, NULL); | ||
255 | DEFINE_CLOCK(ssi1_clk, 0, CCM_CGCR2, 11, get_rate_ssi1, NULL, &ssi1_per_clk); | ||
256 | DEFINE_CLOCK(ssi2_clk, 1, CCM_CGCR2, 12, get_rate_ssi2, NULL, &ssi2_per_clk); | ||
257 | DEFINE_CLOCK(sdma_clk, 0, CCM_CGCR2, 6, get_rate_ipg, NULL, &sdma_ahb_clk); | ||
258 | DEFINE_CLOCK(esdhc1_clk, 0, CCM_CGCR1, 13, get_rate_esdhc1, NULL, | ||
259 | &esdhc1_per_clk); | ||
260 | DEFINE_CLOCK(esdhc2_clk, 1, CCM_CGCR1, 14, get_rate_esdhc2, NULL, | ||
261 | &esdhc2_per_clk); | ||
262 | DEFINE_CLOCK(audmux_clk, 0, CCM_CGCR1, 0, NULL, NULL, NULL); | ||
263 | DEFINE_CLOCK(csi_clk, 0, CCM_CGCR1, 4, get_rate_csi, NULL, &csi_per_clk); | ||
264 | DEFINE_CLOCK(can1_clk, 0, CCM_CGCR1, 2, get_rate_ipg, NULL, NULL); | ||
265 | DEFINE_CLOCK(can2_clk, 1, CCM_CGCR1, 3, get_rate_ipg, NULL, NULL); | ||
266 | DEFINE_CLOCK(iim_clk, 0, CCM_CGCR1, 26, NULL, NULL, NULL); | ||
267 | |||
268 | #define _REGISTER_CLOCK(d, n, c) \ | ||
269 | { \ | ||
270 | .dev_id = d, \ | ||
271 | .con_id = n, \ | ||
272 | .clk = &c, \ | ||
273 | }, | ||
274 | |||
275 | static struct clk_lookup lookups[] = { | ||
276 | /* i.mx25 has the i.mx21 type uart */ | ||
277 | _REGISTER_CLOCK("imx21-uart.0", NULL, uart1_clk) | ||
278 | _REGISTER_CLOCK("imx21-uart.1", NULL, uart2_clk) | ||
279 | _REGISTER_CLOCK("imx21-uart.2", NULL, uart3_clk) | ||
280 | _REGISTER_CLOCK("imx21-uart.3", NULL, uart4_clk) | ||
281 | _REGISTER_CLOCK("imx21-uart.4", NULL, uart5_clk) | ||
282 | _REGISTER_CLOCK("mxc-ehci.0", "usb", usbotg_clk) | ||
283 | _REGISTER_CLOCK("mxc-ehci.1", "usb", usbotg_clk) | ||
284 | _REGISTER_CLOCK("mxc-ehci.2", "usb", usbotg_clk) | ||
285 | _REGISTER_CLOCK("fsl-usb2-udc", "usb", usbotg_clk) | ||
286 | _REGISTER_CLOCK("mxc_nand.0", NULL, nfc_clk) | ||
287 | /* i.mx25 has the i.mx35 type cspi */ | ||
288 | _REGISTER_CLOCK("imx35-cspi.0", NULL, cspi1_clk) | ||
289 | _REGISTER_CLOCK("imx35-cspi.1", NULL, cspi2_clk) | ||
290 | _REGISTER_CLOCK("imx35-cspi.2", NULL, cspi3_clk) | ||
291 | _REGISTER_CLOCK("mxc_pwm.0", NULL, pwm1_clk) | ||
292 | _REGISTER_CLOCK("mxc_pwm.1", NULL, pwm2_clk) | ||
293 | _REGISTER_CLOCK("mxc_pwm.2", NULL, pwm3_clk) | ||
294 | _REGISTER_CLOCK("mxc_pwm.3", NULL, pwm4_clk) | ||
295 | _REGISTER_CLOCK("imx-keypad", NULL, kpp_clk) | ||
296 | _REGISTER_CLOCK("mx25-adc", NULL, tsc_clk) | ||
297 | _REGISTER_CLOCK("imx-i2c.0", NULL, i2c_clk) | ||
298 | _REGISTER_CLOCK("imx-i2c.1", NULL, i2c_clk) | ||
299 | _REGISTER_CLOCK("imx-i2c.2", NULL, i2c_clk) | ||
300 | _REGISTER_CLOCK("imx25-fec.0", NULL, fec_clk) | ||
301 | _REGISTER_CLOCK("imxdi_rtc.0", NULL, dryice_clk) | ||
302 | _REGISTER_CLOCK("imx-fb.0", NULL, lcdc_clk) | ||
303 | _REGISTER_CLOCK("imx2-wdt.0", NULL, wdt_clk) | ||
304 | _REGISTER_CLOCK("imx-ssi.0", NULL, ssi1_clk) | ||
305 | _REGISTER_CLOCK("imx-ssi.1", NULL, ssi2_clk) | ||
306 | _REGISTER_CLOCK("sdhci-esdhc-imx25.0", NULL, esdhc1_clk) | ||
307 | _REGISTER_CLOCK("sdhci-esdhc-imx25.1", NULL, esdhc2_clk) | ||
308 | _REGISTER_CLOCK("mx2-camera.0", NULL, csi_clk) | ||
309 | _REGISTER_CLOCK(NULL, "audmux", audmux_clk) | ||
310 | _REGISTER_CLOCK("flexcan.0", NULL, can1_clk) | ||
311 | _REGISTER_CLOCK("flexcan.1", NULL, can2_clk) | ||
312 | /* i.mx25 has the i.mx35 type sdma */ | ||
313 | _REGISTER_CLOCK("imx35-sdma", NULL, sdma_clk) | ||
314 | _REGISTER_CLOCK(NULL, "iim", iim_clk) | ||
315 | }; | ||
316 | |||
317 | int __init mx25_clocks_init(void) | ||
318 | { | ||
319 | clkdev_add_table(lookups, ARRAY_SIZE(lookups)); | ||
320 | |||
321 | /* Turn off all clocks except the ones we need to survive, namely: | ||
322 | * EMI, GPIO1-3 (CCM_CGCR1[18:16]), GPT1, IOMUXC (CCM_CGCR1[27]), IIM, | ||
323 | * SCC | ||
324 | */ | ||
325 | __raw_writel((1 << 19), CRM_BASE + CCM_CGCR0); | ||
326 | __raw_writel((0xf << 16) | (3 << 26), CRM_BASE + CCM_CGCR1); | ||
327 | __raw_writel((1 << 5), CRM_BASE + CCM_CGCR2); | ||
328 | #if defined(CONFIG_DEBUG_LL) && !defined(CONFIG_DEBUG_ICEDCC) | ||
329 | clk_enable(&uart1_clk); | ||
330 | #endif | ||
331 | |||
332 | /* Clock source for lcdc and csi is upll */ | ||
333 | __raw_writel(__raw_readl(CRM_BASE+0x64) | (1 << 7) | (1 << 0), | ||
334 | CRM_BASE + 0x64); | ||
335 | |||
336 | /* Clock source for gpt is ahb_div */ | ||
337 | __raw_writel(__raw_readl(CRM_BASE+0x64) & ~(1 << 5), CRM_BASE + 0x64); | ||
338 | |||
339 | clk_enable(&iim_clk); | ||
340 | imx_print_silicon_rev("i.MX25", mx25_revision()); | ||
341 | clk_disable(&iim_clk); | ||
342 | |||
343 | mxc_timer_init(&gpt_clk, MX25_IO_ADDRESS(MX25_GPT1_BASE_ADDR), 54); | ||
344 | |||
345 | return 0; | ||
346 | } | ||
diff --git a/arch/arm/mach-imx/clock-imx27.c b/arch/arm/mach-imx/clock-imx27.c deleted file mode 100644 index 98e04f5a87dd..000000000000 --- a/arch/arm/mach-imx/clock-imx27.c +++ /dev/null | |||
@@ -1,785 +0,0 @@ | |||
1 | /* | ||
2 | * Copyright 2004-2007 Freescale Semiconductor, Inc. All Rights Reserved. | ||
3 | * Copyright 2008 Juergen Beisert, kernel@pengutronix.de | ||
4 | * Copyright 2008 Martin Fuzzey, mfuzzey@gmail.com | ||
5 | * | ||
6 | * This program is free software; you can redistribute it and/or | ||
7 | * modify it under the terms of the GNU General Public License | ||
8 | * as published by the Free Software Foundation; either version 2 | ||
9 | * of the License, or (at your option) any later version. | ||
10 | * This program is distributed in the hope that it will be useful, | ||
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
13 | * GNU General Public License for more details. | ||
14 | * | ||
15 | * You should have received a copy of the GNU General Public License | ||
16 | * along with this program; if not, write to the Free Software | ||
17 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, | ||
18 | * MA 02110-1301, USA. | ||
19 | */ | ||
20 | |||
21 | #include <linux/clk.h> | ||
22 | #include <linux/io.h> | ||
23 | #include <linux/module.h> | ||
24 | #include <linux/clkdev.h> | ||
25 | #include <linux/of.h> | ||
26 | |||
27 | #include <asm/div64.h> | ||
28 | |||
29 | #include <mach/clock.h> | ||
30 | #include <mach/common.h> | ||
31 | #include <mach/hardware.h> | ||
32 | |||
33 | #define IO_ADDR_CCM(off) (MX27_IO_ADDRESS(MX27_CCM_BASE_ADDR + (off))) | ||
34 | |||
35 | /* Register offsets */ | ||
36 | #define CCM_CSCR IO_ADDR_CCM(0x0) | ||
37 | #define CCM_MPCTL0 IO_ADDR_CCM(0x4) | ||
38 | #define CCM_MPCTL1 IO_ADDR_CCM(0x8) | ||
39 | #define CCM_SPCTL0 IO_ADDR_CCM(0xc) | ||
40 | #define CCM_SPCTL1 IO_ADDR_CCM(0x10) | ||
41 | #define CCM_OSC26MCTL IO_ADDR_CCM(0x14) | ||
42 | #define CCM_PCDR0 IO_ADDR_CCM(0x18) | ||
43 | #define CCM_PCDR1 IO_ADDR_CCM(0x1c) | ||
44 | #define CCM_PCCR0 IO_ADDR_CCM(0x20) | ||
45 | #define CCM_PCCR1 IO_ADDR_CCM(0x24) | ||
46 | #define CCM_CCSR IO_ADDR_CCM(0x28) | ||
47 | #define CCM_PMCTL IO_ADDR_CCM(0x2c) | ||
48 | #define CCM_PMCOUNT IO_ADDR_CCM(0x30) | ||
49 | #define CCM_WKGDCTL IO_ADDR_CCM(0x34) | ||
50 | |||
51 | #define CCM_CSCR_UPDATE_DIS (1 << 31) | ||
52 | #define CCM_CSCR_SSI2 (1 << 23) | ||
53 | #define CCM_CSCR_SSI1 (1 << 22) | ||
54 | #define CCM_CSCR_VPU (1 << 21) | ||
55 | #define CCM_CSCR_MSHC (1 << 20) | ||
56 | #define CCM_CSCR_SPLLRES (1 << 19) | ||
57 | #define CCM_CSCR_MPLLRES (1 << 18) | ||
58 | #define CCM_CSCR_SP (1 << 17) | ||
59 | #define CCM_CSCR_MCU (1 << 16) | ||
60 | #define CCM_CSCR_OSC26MDIV (1 << 4) | ||
61 | #define CCM_CSCR_OSC26M (1 << 3) | ||
62 | #define CCM_CSCR_FPM (1 << 2) | ||
63 | #define CCM_CSCR_SPEN (1 << 1) | ||
64 | #define CCM_CSCR_MPEN (1 << 0) | ||
65 | |||
66 | /* i.MX27 TO 2+ */ | ||
67 | #define CCM_CSCR_ARM_SRC (1 << 15) | ||
68 | |||
69 | #define CCM_SPCTL1_LF (1 << 15) | ||
70 | #define CCM_SPCTL1_BRMO (1 << 6) | ||
71 | |||
72 | static struct clk mpll_main1_clk, mpll_main2_clk; | ||
73 | |||
74 | static int clk_pccr_enable(struct clk *clk) | ||
75 | { | ||
76 | unsigned long reg; | ||
77 | |||
78 | if (!clk->enable_reg) | ||
79 | return 0; | ||
80 | |||
81 | reg = __raw_readl(clk->enable_reg); | ||
82 | reg |= 1 << clk->enable_shift; | ||
83 | __raw_writel(reg, clk->enable_reg); | ||
84 | |||
85 | return 0; | ||
86 | } | ||
87 | |||
88 | static void clk_pccr_disable(struct clk *clk) | ||
89 | { | ||
90 | unsigned long reg; | ||
91 | |||
92 | if (!clk->enable_reg) | ||
93 | return; | ||
94 | |||
95 | reg = __raw_readl(clk->enable_reg); | ||
96 | reg &= ~(1 << clk->enable_shift); | ||
97 | __raw_writel(reg, clk->enable_reg); | ||
98 | } | ||
99 | |||
100 | static int clk_spll_enable(struct clk *clk) | ||
101 | { | ||
102 | unsigned long reg; | ||
103 | |||
104 | reg = __raw_readl(CCM_CSCR); | ||
105 | reg |= CCM_CSCR_SPEN; | ||
106 | __raw_writel(reg, CCM_CSCR); | ||
107 | |||
108 | while (!(__raw_readl(CCM_SPCTL1) & CCM_SPCTL1_LF)); | ||
109 | |||
110 | return 0; | ||
111 | } | ||
112 | |||
113 | static void clk_spll_disable(struct clk *clk) | ||
114 | { | ||
115 | unsigned long reg; | ||
116 | |||
117 | reg = __raw_readl(CCM_CSCR); | ||
118 | reg &= ~CCM_CSCR_SPEN; | ||
119 | __raw_writel(reg, CCM_CSCR); | ||
120 | } | ||
121 | |||
122 | static int clk_cpu_set_parent(struct clk *clk, struct clk *parent) | ||
123 | { | ||
124 | int cscr = __raw_readl(CCM_CSCR); | ||
125 | |||
126 | if (clk->parent == parent) | ||
127 | return 0; | ||
128 | |||
129 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0) { | ||
130 | if (parent == &mpll_main1_clk) { | ||
131 | cscr |= CCM_CSCR_ARM_SRC; | ||
132 | } else { | ||
133 | if (parent == &mpll_main2_clk) | ||
134 | cscr &= ~CCM_CSCR_ARM_SRC; | ||
135 | else | ||
136 | return -EINVAL; | ||
137 | } | ||
138 | __raw_writel(cscr, CCM_CSCR); | ||
139 | clk->parent = parent; | ||
140 | return 0; | ||
141 | } | ||
142 | return -ENODEV; | ||
143 | } | ||
144 | |||
145 | static unsigned long round_rate_cpu(struct clk *clk, unsigned long rate) | ||
146 | { | ||
147 | int div; | ||
148 | unsigned long parent_rate; | ||
149 | |||
150 | parent_rate = clk_get_rate(clk->parent); | ||
151 | |||
152 | div = parent_rate / rate; | ||
153 | if (parent_rate % rate) | ||
154 | div++; | ||
155 | |||
156 | if (div > 4) | ||
157 | div = 4; | ||
158 | |||
159 | return parent_rate / div; | ||
160 | } | ||
161 | |||
162 | static int set_rate_cpu(struct clk *clk, unsigned long rate) | ||
163 | { | ||
164 | unsigned int div; | ||
165 | uint32_t reg; | ||
166 | unsigned long parent_rate; | ||
167 | |||
168 | parent_rate = clk_get_rate(clk->parent); | ||
169 | |||
170 | div = parent_rate / rate; | ||
171 | |||
172 | if (div > 4 || div < 1 || ((parent_rate / div) != rate)) | ||
173 | return -EINVAL; | ||
174 | |||
175 | div--; | ||
176 | |||
177 | reg = __raw_readl(CCM_CSCR); | ||
178 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0) { | ||
179 | reg &= ~(3 << 12); | ||
180 | reg |= div << 12; | ||
181 | reg &= ~(CCM_CSCR_FPM | CCM_CSCR_SPEN); | ||
182 | __raw_writel(reg | CCM_CSCR_UPDATE_DIS, CCM_CSCR); | ||
183 | } else { | ||
184 | printk(KERN_ERR "Can't set CPU frequency!\n"); | ||
185 | } | ||
186 | |||
187 | return 0; | ||
188 | } | ||
189 | |||
190 | static unsigned long round_rate_per(struct clk *clk, unsigned long rate) | ||
191 | { | ||
192 | u32 div; | ||
193 | unsigned long parent_rate; | ||
194 | |||
195 | parent_rate = clk_get_rate(clk->parent); | ||
196 | |||
197 | div = parent_rate / rate; | ||
198 | if (parent_rate % rate) | ||
199 | div++; | ||
200 | |||
201 | if (div > 64) | ||
202 | div = 64; | ||
203 | |||
204 | return parent_rate / div; | ||
205 | } | ||
206 | |||
207 | static int set_rate_per(struct clk *clk, unsigned long rate) | ||
208 | { | ||
209 | u32 reg; | ||
210 | u32 div; | ||
211 | unsigned long parent_rate; | ||
212 | |||
213 | parent_rate = clk_get_rate(clk->parent); | ||
214 | |||
215 | if (clk->id < 0 || clk->id > 3) | ||
216 | return -EINVAL; | ||
217 | |||
218 | div = parent_rate / rate; | ||
219 | if (div > 64 || div < 1 || ((parent_rate / div) != rate)) | ||
220 | return -EINVAL; | ||
221 | div--; | ||
222 | |||
223 | reg = __raw_readl(CCM_PCDR1) & ~(0x3f << (clk->id << 3)); | ||
224 | reg |= div << (clk->id << 3); | ||
225 | __raw_writel(reg, CCM_PCDR1); | ||
226 | |||
227 | return 0; | ||
228 | } | ||
229 | |||
230 | static unsigned long get_rate_usb(struct clk *clk) | ||
231 | { | ||
232 | unsigned long usb_pdf; | ||
233 | unsigned long parent_rate; | ||
234 | |||
235 | parent_rate = clk_get_rate(clk->parent); | ||
236 | |||
237 | usb_pdf = (__raw_readl(CCM_CSCR) >> 28) & 0x7; | ||
238 | |||
239 | return parent_rate / (usb_pdf + 1U); | ||
240 | } | ||
241 | |||
242 | static unsigned long get_rate_ssix(struct clk *clk, unsigned long pdf) | ||
243 | { | ||
244 | unsigned long parent_rate; | ||
245 | |||
246 | parent_rate = clk_get_rate(clk->parent); | ||
247 | |||
248 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0) | ||
249 | pdf += 4; /* MX27 TO2+ */ | ||
250 | else | ||
251 | pdf = (pdf < 2) ? 124UL : pdf; /* MX21 & MX27 TO1 */ | ||
252 | |||
253 | return 2UL * parent_rate / pdf; | ||
254 | } | ||
255 | |||
256 | static unsigned long get_rate_ssi1(struct clk *clk) | ||
257 | { | ||
258 | return get_rate_ssix(clk, (__raw_readl(CCM_PCDR0) >> 16) & 0x3f); | ||
259 | } | ||
260 | |||
261 | static unsigned long get_rate_ssi2(struct clk *clk) | ||
262 | { | ||
263 | return get_rate_ssix(clk, (__raw_readl(CCM_PCDR0) >> 26) & 0x3f); | ||
264 | } | ||
265 | |||
266 | static unsigned long get_rate_nfc(struct clk *clk) | ||
267 | { | ||
268 | unsigned long nfc_pdf; | ||
269 | unsigned long parent_rate; | ||
270 | |||
271 | parent_rate = clk_get_rate(clk->parent); | ||
272 | |||
273 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0) | ||
274 | nfc_pdf = (__raw_readl(CCM_PCDR0) >> 6) & 0xf; | ||
275 | else | ||
276 | nfc_pdf = (__raw_readl(CCM_PCDR0) >> 12) & 0xf; | ||
277 | |||
278 | return parent_rate / (nfc_pdf + 1); | ||
279 | } | ||
280 | |||
281 | static unsigned long get_rate_vpu(struct clk *clk) | ||
282 | { | ||
283 | unsigned long vpu_pdf; | ||
284 | unsigned long parent_rate; | ||
285 | |||
286 | parent_rate = clk_get_rate(clk->parent); | ||
287 | |||
288 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0) { | ||
289 | vpu_pdf = (__raw_readl(CCM_PCDR0) >> 10) & 0x3f; | ||
290 | vpu_pdf += 4; | ||
291 | } else { | ||
292 | vpu_pdf = (__raw_readl(CCM_PCDR0) >> 8) & 0xf; | ||
293 | vpu_pdf = (vpu_pdf < 2) ? 124 : vpu_pdf; | ||
294 | } | ||
295 | |||
296 | return 2UL * parent_rate / vpu_pdf; | ||
297 | } | ||
298 | |||
299 | static unsigned long round_rate_parent(struct clk *clk, unsigned long rate) | ||
300 | { | ||
301 | return clk->parent->round_rate(clk->parent, rate); | ||
302 | } | ||
303 | |||
304 | static unsigned long get_rate_parent(struct clk *clk) | ||
305 | { | ||
306 | return clk_get_rate(clk->parent); | ||
307 | } | ||
308 | |||
309 | static int set_rate_parent(struct clk *clk, unsigned long rate) | ||
310 | { | ||
311 | return clk->parent->set_rate(clk->parent, rate); | ||
312 | } | ||
313 | |||
314 | /* in Hz */ | ||
315 | static unsigned long external_high_reference = 26000000; | ||
316 | |||
317 | static unsigned long get_rate_high_reference(struct clk *clk) | ||
318 | { | ||
319 | return external_high_reference; | ||
320 | } | ||
321 | |||
322 | /* in Hz */ | ||
323 | static unsigned long external_low_reference = 32768; | ||
324 | |||
325 | static unsigned long get_rate_low_reference(struct clk *clk) | ||
326 | { | ||
327 | return external_low_reference; | ||
328 | } | ||
329 | |||
330 | static unsigned long get_rate_fpm(struct clk *clk) | ||
331 | { | ||
332 | return clk_get_rate(clk->parent) * 1024; | ||
333 | } | ||
334 | |||
335 | static unsigned long get_rate_mpll(struct clk *clk) | ||
336 | { | ||
337 | return mxc_decode_pll(__raw_readl(CCM_MPCTL0), | ||
338 | clk_get_rate(clk->parent)); | ||
339 | } | ||
340 | |||
341 | static unsigned long get_rate_mpll_main(struct clk *clk) | ||
342 | { | ||
343 | unsigned long parent_rate; | ||
344 | |||
345 | parent_rate = clk_get_rate(clk->parent); | ||
346 | |||
347 | /* i.MX27 TO2: | ||
348 | * clk->id == 0: arm clock source path 1 which is from 2 * MPLL / 2 | ||
349 | * clk->id == 1: arm clock source path 2 which is from 2 * MPLL / 3 | ||
350 | */ | ||
351 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0 && clk->id == 1) | ||
352 | return 2UL * parent_rate / 3UL; | ||
353 | |||
354 | return parent_rate; | ||
355 | } | ||
356 | |||
357 | static unsigned long get_rate_spll(struct clk *clk) | ||
358 | { | ||
359 | uint32_t reg; | ||
360 | unsigned long rate; | ||
361 | |||
362 | rate = clk_get_rate(clk->parent); | ||
363 | |||
364 | reg = __raw_readl(CCM_SPCTL0); | ||
365 | |||
366 | /* On TO2 we have to write the value back. Otherwise we | ||
367 | * read 0 from this register the next time. | ||
368 | */ | ||
369 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0) | ||
370 | __raw_writel(reg, CCM_SPCTL0); | ||
371 | |||
372 | return mxc_decode_pll(reg, rate); | ||
373 | } | ||
374 | |||
375 | static unsigned long get_rate_cpu(struct clk *clk) | ||
376 | { | ||
377 | u32 div; | ||
378 | unsigned long rate; | ||
379 | |||
380 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0) | ||
381 | div = (__raw_readl(CCM_CSCR) >> 12) & 0x3; | ||
382 | else | ||
383 | div = (__raw_readl(CCM_CSCR) >> 13) & 0x7; | ||
384 | |||
385 | rate = clk_get_rate(clk->parent); | ||
386 | return rate / (div + 1); | ||
387 | } | ||
388 | |||
389 | static unsigned long get_rate_ahb(struct clk *clk) | ||
390 | { | ||
391 | unsigned long rate, bclk_pdf; | ||
392 | |||
393 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0) | ||
394 | bclk_pdf = (__raw_readl(CCM_CSCR) >> 8) & 0x3; | ||
395 | else | ||
396 | bclk_pdf = (__raw_readl(CCM_CSCR) >> 9) & 0xf; | ||
397 | |||
398 | rate = clk_get_rate(clk->parent); | ||
399 | return rate / (bclk_pdf + 1); | ||
400 | } | ||
401 | |||
402 | static unsigned long get_rate_ipg(struct clk *clk) | ||
403 | { | ||
404 | unsigned long rate, ipg_pdf; | ||
405 | |||
406 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0) | ||
407 | return clk_get_rate(clk->parent); | ||
408 | else | ||
409 | ipg_pdf = (__raw_readl(CCM_CSCR) >> 8) & 1; | ||
410 | |||
411 | rate = clk_get_rate(clk->parent); | ||
412 | return rate / (ipg_pdf + 1); | ||
413 | } | ||
414 | |||
415 | static unsigned long get_rate_per(struct clk *clk) | ||
416 | { | ||
417 | unsigned long perclk_pdf, parent_rate; | ||
418 | |||
419 | parent_rate = clk_get_rate(clk->parent); | ||
420 | |||
421 | if (clk->id < 0 || clk->id > 3) | ||
422 | return 0; | ||
423 | |||
424 | perclk_pdf = (__raw_readl(CCM_PCDR1) >> (clk->id << 3)) & 0x3f; | ||
425 | |||
426 | return parent_rate / (perclk_pdf + 1); | ||
427 | } | ||
428 | |||
429 | /* | ||
430 | * the high frequency external clock reference | ||
431 | * Default case is 26MHz. Could be changed at runtime | ||
432 | * with a call to change_external_high_reference() | ||
433 | */ | ||
434 | static struct clk ckih_clk = { | ||
435 | .get_rate = get_rate_high_reference, | ||
436 | }; | ||
437 | |||
438 | static struct clk mpll_clk = { | ||
439 | .parent = &ckih_clk, | ||
440 | .get_rate = get_rate_mpll, | ||
441 | }; | ||
442 | |||
443 | /* For i.MX27 TO2, it is the MPLL path 1 of ARM core | ||
444 | * It provides the clock source whose rate is same as MPLL | ||
445 | */ | ||
446 | static struct clk mpll_main1_clk = { | ||
447 | .id = 0, | ||
448 | .parent = &mpll_clk, | ||
449 | .get_rate = get_rate_mpll_main, | ||
450 | }; | ||
451 | |||
452 | /* For i.MX27 TO2, it is the MPLL path 2 of ARM core | ||
453 | * It provides the clock source whose rate is same MPLL * 2 / 3 | ||
454 | */ | ||
455 | static struct clk mpll_main2_clk = { | ||
456 | .id = 1, | ||
457 | .parent = &mpll_clk, | ||
458 | .get_rate = get_rate_mpll_main, | ||
459 | }; | ||
460 | |||
461 | static struct clk ahb_clk = { | ||
462 | .parent = &mpll_main2_clk, | ||
463 | .get_rate = get_rate_ahb, | ||
464 | }; | ||
465 | |||
466 | static struct clk ipg_clk = { | ||
467 | .parent = &ahb_clk, | ||
468 | .get_rate = get_rate_ipg, | ||
469 | }; | ||
470 | |||
471 | static struct clk cpu_clk = { | ||
472 | .parent = &mpll_main2_clk, | ||
473 | .set_parent = clk_cpu_set_parent, | ||
474 | .round_rate = round_rate_cpu, | ||
475 | .get_rate = get_rate_cpu, | ||
476 | .set_rate = set_rate_cpu, | ||
477 | }; | ||
478 | |||
479 | static struct clk spll_clk = { | ||
480 | .parent = &ckih_clk, | ||
481 | .get_rate = get_rate_spll, | ||
482 | .enable = clk_spll_enable, | ||
483 | .disable = clk_spll_disable, | ||
484 | }; | ||
485 | |||
486 | /* | ||
487 | * the low frequency external clock reference | ||
488 | * Default case is 32.768kHz. | ||
489 | */ | ||
490 | static struct clk ckil_clk = { | ||
491 | .get_rate = get_rate_low_reference, | ||
492 | }; | ||
493 | |||
494 | /* Output of frequency pre multiplier */ | ||
495 | static struct clk fpm_clk = { | ||
496 | .parent = &ckil_clk, | ||
497 | .get_rate = get_rate_fpm, | ||
498 | }; | ||
499 | |||
500 | #define PCCR0 CCM_PCCR0 | ||
501 | #define PCCR1 CCM_PCCR1 | ||
502 | |||
503 | #define DEFINE_CLOCK(name, i, er, es, gr, s, p) \ | ||
504 | static struct clk name = { \ | ||
505 | .id = i, \ | ||
506 | .enable_reg = er, \ | ||
507 | .enable_shift = es, \ | ||
508 | .get_rate = gr, \ | ||
509 | .enable = clk_pccr_enable, \ | ||
510 | .disable = clk_pccr_disable, \ | ||
511 | .secondary = s, \ | ||
512 | .parent = p, \ | ||
513 | } | ||
514 | |||
515 | #define DEFINE_CLOCK1(name, i, er, es, getsetround, s, p) \ | ||
516 | static struct clk name = { \ | ||
517 | .id = i, \ | ||
518 | .enable_reg = er, \ | ||
519 | .enable_shift = es, \ | ||
520 | .get_rate = get_rate_##getsetround, \ | ||
521 | .set_rate = set_rate_##getsetround, \ | ||
522 | .round_rate = round_rate_##getsetround, \ | ||
523 | .enable = clk_pccr_enable, \ | ||
524 | .disable = clk_pccr_disable, \ | ||
525 | .secondary = s, \ | ||
526 | .parent = p, \ | ||
527 | } | ||
528 | |||
529 | /* Forward declaration to keep the following list in order */ | ||
530 | static struct clk slcdc_clk1, sahara2_clk1, rtic_clk1, fec_clk1, emma_clk1, | ||
531 | dma_clk1, lcdc_clk2, vpu_clk1; | ||
532 | |||
533 | /* All clocks we can gate through PCCRx in the order of PCCRx bits */ | ||
534 | DEFINE_CLOCK(ssi2_clk1, 1, PCCR0, 0, NULL, NULL, &ipg_clk); | ||
535 | DEFINE_CLOCK(ssi1_clk1, 0, PCCR0, 1, NULL, NULL, &ipg_clk); | ||
536 | DEFINE_CLOCK(slcdc_clk, 0, PCCR0, 2, NULL, &slcdc_clk1, &ahb_clk); | ||
537 | DEFINE_CLOCK(sdhc3_clk1, 0, PCCR0, 3, NULL, NULL, &ipg_clk); | ||
538 | DEFINE_CLOCK(sdhc2_clk1, 0, PCCR0, 4, NULL, NULL, &ipg_clk); | ||
539 | DEFINE_CLOCK(sdhc1_clk1, 0, PCCR0, 5, NULL, NULL, &ipg_clk); | ||
540 | DEFINE_CLOCK(scc_clk, 0, PCCR0, 6, NULL, NULL, &ipg_clk); | ||
541 | DEFINE_CLOCK(sahara2_clk, 0, PCCR0, 7, NULL, &sahara2_clk1, &ahb_clk); | ||
542 | DEFINE_CLOCK(rtic_clk, 0, PCCR0, 8, NULL, &rtic_clk1, &ahb_clk); | ||
543 | DEFINE_CLOCK(rtc_clk, 0, PCCR0, 9, NULL, NULL, &ipg_clk); | ||
544 | DEFINE_CLOCK(pwm_clk1, 0, PCCR0, 11, NULL, NULL, &ipg_clk); | ||
545 | DEFINE_CLOCK(owire_clk, 0, PCCR0, 12, NULL, NULL, &ipg_clk); | ||
546 | DEFINE_CLOCK(mstick_clk1, 0, PCCR0, 13, NULL, NULL, &ipg_clk); | ||
547 | DEFINE_CLOCK(lcdc_clk1, 0, PCCR0, 14, NULL, &lcdc_clk2, &ipg_clk); | ||
548 | DEFINE_CLOCK(kpp_clk, 0, PCCR0, 15, NULL, NULL, &ipg_clk); | ||
549 | DEFINE_CLOCK(iim_clk, 0, PCCR0, 16, NULL, NULL, &ipg_clk); | ||
550 | DEFINE_CLOCK(i2c2_clk, 1, PCCR0, 17, NULL, NULL, &ipg_clk); | ||
551 | DEFINE_CLOCK(i2c1_clk, 0, PCCR0, 18, NULL, NULL, &ipg_clk); | ||
552 | DEFINE_CLOCK(gpt6_clk1, 0, PCCR0, 29, NULL, NULL, &ipg_clk); | ||
553 | DEFINE_CLOCK(gpt5_clk1, 0, PCCR0, 20, NULL, NULL, &ipg_clk); | ||
554 | DEFINE_CLOCK(gpt4_clk1, 0, PCCR0, 21, NULL, NULL, &ipg_clk); | ||
555 | DEFINE_CLOCK(gpt3_clk1, 0, PCCR0, 22, NULL, NULL, &ipg_clk); | ||
556 | DEFINE_CLOCK(gpt2_clk1, 0, PCCR0, 23, NULL, NULL, &ipg_clk); | ||
557 | DEFINE_CLOCK(gpt1_clk1, 0, PCCR0, 24, NULL, NULL, &ipg_clk); | ||
558 | DEFINE_CLOCK(gpio_clk, 0, PCCR0, 25, NULL, NULL, &ipg_clk); | ||
559 | DEFINE_CLOCK(fec_clk, 0, PCCR0, 26, NULL, &fec_clk1, &ahb_clk); | ||
560 | DEFINE_CLOCK(emma_clk, 0, PCCR0, 27, NULL, &emma_clk1, &ahb_clk); | ||
561 | DEFINE_CLOCK(dma_clk, 0, PCCR0, 28, NULL, &dma_clk1, &ahb_clk); | ||
562 | DEFINE_CLOCK(cspi13_clk1, 0, PCCR0, 29, NULL, NULL, &ipg_clk); | ||
563 | DEFINE_CLOCK(cspi2_clk1, 0, PCCR0, 30, NULL, NULL, &ipg_clk); | ||
564 | DEFINE_CLOCK(cspi1_clk1, 0, PCCR0, 31, NULL, NULL, &ipg_clk); | ||
565 | |||
566 | DEFINE_CLOCK(mstick_clk, 0, PCCR1, 2, NULL, &mstick_clk1, &ipg_clk); | ||
567 | DEFINE_CLOCK(nfc_clk, 0, PCCR1, 3, get_rate_nfc, NULL, &cpu_clk); | ||
568 | DEFINE_CLOCK(ssi2_clk, 1, PCCR1, 4, get_rate_ssi2, &ssi2_clk1, &mpll_main2_clk); | ||
569 | DEFINE_CLOCK(ssi1_clk, 0, PCCR1, 5, get_rate_ssi1, &ssi1_clk1, &mpll_main2_clk); | ||
570 | DEFINE_CLOCK(vpu_clk, 0, PCCR1, 6, get_rate_vpu, &vpu_clk1, &mpll_main2_clk); | ||
571 | DEFINE_CLOCK1(per4_clk, 3, PCCR1, 7, per, NULL, &mpll_main2_clk); | ||
572 | DEFINE_CLOCK1(per3_clk, 2, PCCR1, 8, per, NULL, &mpll_main2_clk); | ||
573 | DEFINE_CLOCK1(per2_clk, 1, PCCR1, 9, per, NULL, &mpll_main2_clk); | ||
574 | DEFINE_CLOCK1(per1_clk, 0, PCCR1, 10, per, NULL, &mpll_main2_clk); | ||
575 | DEFINE_CLOCK(usb_clk1, 0, PCCR1, 11, NULL, NULL, &ahb_clk); | ||
576 | DEFINE_CLOCK(slcdc_clk1, 0, PCCR1, 12, NULL, NULL, &ahb_clk); | ||
577 | DEFINE_CLOCK(sahara2_clk1, 0, PCCR1, 13, NULL, NULL, &ahb_clk); | ||
578 | DEFINE_CLOCK(rtic_clk1, 0, PCCR1, 14, NULL, NULL, &ahb_clk); | ||
579 | DEFINE_CLOCK(lcdc_clk2, 0, PCCR1, 15, NULL, NULL, &ahb_clk); | ||
580 | DEFINE_CLOCK(vpu_clk1, 0, PCCR1, 16, NULL, NULL, &ahb_clk); | ||
581 | DEFINE_CLOCK(fec_clk1, 0, PCCR1, 17, NULL, NULL, &ahb_clk); | ||
582 | DEFINE_CLOCK(emma_clk1, 0, PCCR1, 18, NULL, NULL, &ahb_clk); | ||
583 | DEFINE_CLOCK(emi_clk, 0, PCCR1, 19, NULL, NULL, &ahb_clk); | ||
584 | DEFINE_CLOCK(dma_clk1, 0, PCCR1, 20, NULL, NULL, &ahb_clk); | ||
585 | DEFINE_CLOCK(csi_clk1, 0, PCCR1, 21, NULL, NULL, &ahb_clk); | ||
586 | DEFINE_CLOCK(brom_clk, 0, PCCR1, 22, NULL, NULL, &ahb_clk); | ||
587 | DEFINE_CLOCK(pata_clk, 0, PCCR1, 23, NULL, NULL, &ahb_clk); | ||
588 | DEFINE_CLOCK(wdog_clk, 0, PCCR1, 24, NULL, NULL, &ipg_clk); | ||
589 | DEFINE_CLOCK(usb_clk, 0, PCCR1, 25, get_rate_usb, &usb_clk1, &spll_clk); | ||
590 | DEFINE_CLOCK(uart6_clk1, 0, PCCR1, 26, NULL, NULL, &ipg_clk); | ||
591 | DEFINE_CLOCK(uart5_clk1, 0, PCCR1, 27, NULL, NULL, &ipg_clk); | ||
592 | DEFINE_CLOCK(uart4_clk1, 0, PCCR1, 28, NULL, NULL, &ipg_clk); | ||
593 | DEFINE_CLOCK(uart3_clk1, 0, PCCR1, 29, NULL, NULL, &ipg_clk); | ||
594 | DEFINE_CLOCK(uart2_clk1, 0, PCCR1, 30, NULL, NULL, &ipg_clk); | ||
595 | DEFINE_CLOCK(uart1_clk1, 0, PCCR1, 31, NULL, NULL, &ipg_clk); | ||
596 | |||
597 | /* Clocks we cannot directly gate, but drivers need their rates */ | ||
598 | DEFINE_CLOCK(cspi1_clk, 0, NULL, 0, NULL, &cspi1_clk1, &per2_clk); | ||
599 | DEFINE_CLOCK(cspi2_clk, 1, NULL, 0, NULL, &cspi2_clk1, &per2_clk); | ||
600 | DEFINE_CLOCK(cspi3_clk, 2, NULL, 0, NULL, &cspi13_clk1, &per2_clk); | ||
601 | DEFINE_CLOCK(sdhc1_clk, 0, NULL, 0, NULL, &sdhc1_clk1, &per2_clk); | ||
602 | DEFINE_CLOCK(sdhc2_clk, 1, NULL, 0, NULL, &sdhc2_clk1, &per2_clk); | ||
603 | DEFINE_CLOCK(sdhc3_clk, 2, NULL, 0, NULL, &sdhc3_clk1, &per2_clk); | ||
604 | DEFINE_CLOCK(pwm_clk, 0, NULL, 0, NULL, &pwm_clk1, &per1_clk); | ||
605 | DEFINE_CLOCK(gpt1_clk, 0, NULL, 0, NULL, &gpt1_clk1, &per1_clk); | ||
606 | DEFINE_CLOCK(gpt2_clk, 1, NULL, 0, NULL, &gpt2_clk1, &per1_clk); | ||
607 | DEFINE_CLOCK(gpt3_clk, 2, NULL, 0, NULL, &gpt3_clk1, &per1_clk); | ||
608 | DEFINE_CLOCK(gpt4_clk, 3, NULL, 0, NULL, &gpt4_clk1, &per1_clk); | ||
609 | DEFINE_CLOCK(gpt5_clk, 4, NULL, 0, NULL, &gpt5_clk1, &per1_clk); | ||
610 | DEFINE_CLOCK(gpt6_clk, 5, NULL, 0, NULL, &gpt6_clk1, &per1_clk); | ||
611 | DEFINE_CLOCK(uart1_clk, 0, NULL, 0, NULL, &uart1_clk1, &per1_clk); | ||
612 | DEFINE_CLOCK(uart2_clk, 1, NULL, 0, NULL, &uart2_clk1, &per1_clk); | ||
613 | DEFINE_CLOCK(uart3_clk, 2, NULL, 0, NULL, &uart3_clk1, &per1_clk); | ||
614 | DEFINE_CLOCK(uart4_clk, 3, NULL, 0, NULL, &uart4_clk1, &per1_clk); | ||
615 | DEFINE_CLOCK(uart5_clk, 4, NULL, 0, NULL, &uart5_clk1, &per1_clk); | ||
616 | DEFINE_CLOCK(uart6_clk, 5, NULL, 0, NULL, &uart6_clk1, &per1_clk); | ||
617 | DEFINE_CLOCK1(lcdc_clk, 0, NULL, 0, parent, &lcdc_clk1, &per3_clk); | ||
618 | DEFINE_CLOCK1(csi_clk, 0, NULL, 0, parent, &csi_clk1, &per4_clk); | ||
619 | |||
620 | #define _REGISTER_CLOCK(d, n, c) \ | ||
621 | { \ | ||
622 | .dev_id = d, \ | ||
623 | .con_id = n, \ | ||
624 | .clk = &c, \ | ||
625 | }, | ||
626 | |||
627 | static struct clk_lookup lookups[] = { | ||
628 | /* i.mx27 has the i.mx21 type uart */ | ||
629 | _REGISTER_CLOCK("imx21-uart.0", NULL, uart1_clk) | ||
630 | _REGISTER_CLOCK("imx21-uart.1", NULL, uart2_clk) | ||
631 | _REGISTER_CLOCK("imx21-uart.2", NULL, uart3_clk) | ||
632 | _REGISTER_CLOCK("imx21-uart.3", NULL, uart4_clk) | ||
633 | _REGISTER_CLOCK("imx21-uart.4", NULL, uart5_clk) | ||
634 | _REGISTER_CLOCK("imx21-uart.5", NULL, uart6_clk) | ||
635 | _REGISTER_CLOCK(NULL, "gpt1", gpt1_clk) | ||
636 | _REGISTER_CLOCK(NULL, "gpt2", gpt2_clk) | ||
637 | _REGISTER_CLOCK(NULL, "gpt3", gpt3_clk) | ||
638 | _REGISTER_CLOCK(NULL, "gpt4", gpt4_clk) | ||
639 | _REGISTER_CLOCK(NULL, "gpt5", gpt5_clk) | ||
640 | _REGISTER_CLOCK(NULL, "gpt6", gpt6_clk) | ||
641 | _REGISTER_CLOCK("mxc_pwm.0", NULL, pwm_clk) | ||
642 | _REGISTER_CLOCK("mxc-mmc.0", NULL, sdhc1_clk) | ||
643 | _REGISTER_CLOCK("mxc-mmc.1", NULL, sdhc2_clk) | ||
644 | _REGISTER_CLOCK("mxc-mmc.2", NULL, sdhc3_clk) | ||
645 | _REGISTER_CLOCK("imx27-cspi.0", NULL, cspi1_clk) | ||
646 | _REGISTER_CLOCK("imx27-cspi.1", NULL, cspi2_clk) | ||
647 | _REGISTER_CLOCK("imx27-cspi.2", NULL, cspi3_clk) | ||
648 | _REGISTER_CLOCK("imx-fb.0", NULL, lcdc_clk) | ||
649 | _REGISTER_CLOCK("mx2-camera.0", NULL, csi_clk) | ||
650 | _REGISTER_CLOCK("fsl-usb2-udc", "usb", usb_clk) | ||
651 | _REGISTER_CLOCK("fsl-usb2-udc", "usb_ahb", usb_clk1) | ||
652 | _REGISTER_CLOCK("mxc-ehci.0", "usb", usb_clk) | ||
653 | _REGISTER_CLOCK("mxc-ehci.0", "usb_ahb", usb_clk1) | ||
654 | _REGISTER_CLOCK("mxc-ehci.1", "usb", usb_clk) | ||
655 | _REGISTER_CLOCK("mxc-ehci.1", "usb_ahb", usb_clk1) | ||
656 | _REGISTER_CLOCK("mxc-ehci.2", "usb", usb_clk) | ||
657 | _REGISTER_CLOCK("mxc-ehci.2", "usb_ahb", usb_clk1) | ||
658 | _REGISTER_CLOCK("imx-ssi.0", NULL, ssi1_clk) | ||
659 | _REGISTER_CLOCK("imx-ssi.1", NULL, ssi2_clk) | ||
660 | _REGISTER_CLOCK("mxc_nand.0", NULL, nfc_clk) | ||
661 | _REGISTER_CLOCK(NULL, "vpu", vpu_clk) | ||
662 | _REGISTER_CLOCK(NULL, "dma", dma_clk) | ||
663 | _REGISTER_CLOCK(NULL, "rtic", rtic_clk) | ||
664 | _REGISTER_CLOCK(NULL, "brom", brom_clk) | ||
665 | _REGISTER_CLOCK(NULL, "emma", emma_clk) | ||
666 | _REGISTER_CLOCK("m2m-emmaprp.0", NULL, emma_clk) | ||
667 | _REGISTER_CLOCK(NULL, "slcdc", slcdc_clk) | ||
668 | _REGISTER_CLOCK("imx27-fec.0", NULL, fec_clk) | ||
669 | _REGISTER_CLOCK(NULL, "emi", emi_clk) | ||
670 | _REGISTER_CLOCK(NULL, "sahara2", sahara2_clk) | ||
671 | _REGISTER_CLOCK("pata_imx", NULL, pata_clk) | ||
672 | _REGISTER_CLOCK(NULL, "mstick", mstick_clk) | ||
673 | _REGISTER_CLOCK("imx2-wdt.0", NULL, wdog_clk) | ||
674 | _REGISTER_CLOCK(NULL, "gpio", gpio_clk) | ||
675 | _REGISTER_CLOCK("imx-i2c.0", NULL, i2c1_clk) | ||
676 | _REGISTER_CLOCK("imx-i2c.1", NULL, i2c2_clk) | ||
677 | _REGISTER_CLOCK(NULL, "iim", iim_clk) | ||
678 | _REGISTER_CLOCK(NULL, "kpp", kpp_clk) | ||
679 | _REGISTER_CLOCK("mxc_w1.0", NULL, owire_clk) | ||
680 | _REGISTER_CLOCK(NULL, "rtc", rtc_clk) | ||
681 | _REGISTER_CLOCK(NULL, "scc", scc_clk) | ||
682 | }; | ||
683 | |||
684 | /* Adjust the clock path for TO2 and later */ | ||
685 | static void __init to2_adjust_clocks(void) | ||
686 | { | ||
687 | unsigned long cscr = __raw_readl(CCM_CSCR); | ||
688 | |||
689 | if (mx27_revision() >= IMX_CHIP_REVISION_2_0) { | ||
690 | if (cscr & CCM_CSCR_ARM_SRC) | ||
691 | cpu_clk.parent = &mpll_main1_clk; | ||
692 | |||
693 | if (!(cscr & CCM_CSCR_SSI2)) | ||
694 | ssi1_clk.parent = &spll_clk; | ||
695 | |||
696 | if (!(cscr & CCM_CSCR_SSI1)) | ||
697 | ssi1_clk.parent = &spll_clk; | ||
698 | |||
699 | if (!(cscr & CCM_CSCR_VPU)) | ||
700 | vpu_clk.parent = &spll_clk; | ||
701 | } else { | ||
702 | cpu_clk.parent = &mpll_clk; | ||
703 | cpu_clk.set_parent = NULL; | ||
704 | cpu_clk.round_rate = NULL; | ||
705 | cpu_clk.set_rate = NULL; | ||
706 | ahb_clk.parent = &mpll_clk; | ||
707 | |||
708 | per1_clk.parent = &mpll_clk; | ||
709 | per2_clk.parent = &mpll_clk; | ||
710 | per3_clk.parent = &mpll_clk; | ||
711 | per4_clk.parent = &mpll_clk; | ||
712 | |||
713 | ssi1_clk.parent = &mpll_clk; | ||
714 | ssi2_clk.parent = &mpll_clk; | ||
715 | |||
716 | vpu_clk.parent = &mpll_clk; | ||
717 | } | ||
718 | } | ||
719 | |||
720 | /* | ||
721 | * must be called very early to get information about the | ||
722 | * available clock rate when the timer framework starts | ||
723 | */ | ||
724 | int __init mx27_clocks_init(unsigned long fref) | ||
725 | { | ||
726 | u32 cscr = __raw_readl(CCM_CSCR); | ||
727 | |||
728 | external_high_reference = fref; | ||
729 | |||
730 | /* detect clock reference for both system PLLs */ | ||
731 | if (cscr & CCM_CSCR_MCU) | ||
732 | mpll_clk.parent = &ckih_clk; | ||
733 | else | ||
734 | mpll_clk.parent = &fpm_clk; | ||
735 | |||
736 | if (cscr & CCM_CSCR_SP) | ||
737 | spll_clk.parent = &ckih_clk; | ||
738 | else | ||
739 | spll_clk.parent = &fpm_clk; | ||
740 | |||
741 | to2_adjust_clocks(); | ||
742 | |||
743 | clkdev_add_table(lookups, ARRAY_SIZE(lookups)); | ||
744 | |||
745 | /* Turn off all clocks we do not need */ | ||
746 | __raw_writel(0, CCM_PCCR0); | ||
747 | __raw_writel((1 << 10) | (1 << 19), CCM_PCCR1); | ||
748 | |||
749 | spll_clk.disable(&spll_clk); | ||
750 | |||
751 | /* enable basic clocks */ | ||
752 | clk_enable(&per1_clk); | ||
753 | clk_enable(&gpio_clk); | ||
754 | clk_enable(&emi_clk); | ||
755 | clk_enable(&iim_clk); | ||
756 | imx_print_silicon_rev("i.MX27", mx27_revision()); | ||
757 | clk_disable(&iim_clk); | ||
758 | |||
759 | #if defined(CONFIG_DEBUG_LL) && !defined(CONFIG_DEBUG_ICEDCC) | ||
760 | clk_enable(&uart1_clk); | ||
761 | #endif | ||
762 | |||
763 | mxc_timer_init(&gpt1_clk, MX27_IO_ADDRESS(MX27_GPT1_BASE_ADDR), | ||
764 | MX27_INT_GPT1); | ||
765 | |||
766 | return 0; | ||
767 | } | ||
768 | |||
769 | #ifdef CONFIG_OF | ||
770 | int __init mx27_clocks_init_dt(void) | ||
771 | { | ||
772 | struct device_node *np; | ||
773 | u32 fref = 26000000; /* default */ | ||
774 | |||
775 | for_each_compatible_node(np, NULL, "fixed-clock") { | ||
776 | if (!of_device_is_compatible(np, "fsl,imx-osc26m")) | ||
777 | continue; | ||
778 | |||
779 | if (!of_property_read_u32(np, "clock-frequency", &fref)) | ||
780 | break; | ||
781 | } | ||
782 | |||
783 | return mx27_clocks_init(fref); | ||
784 | } | ||
785 | #endif | ||
diff --git a/arch/arm/mach-imx/clock-imx31.c b/arch/arm/mach-imx/clock-imx31.c deleted file mode 100644 index 3a943cd4159f..000000000000 --- a/arch/arm/mach-imx/clock-imx31.c +++ /dev/null | |||
@@ -1,630 +0,0 @@ | |||
1 | /* | ||
2 | * Copyright 2005-2007 Freescale Semiconductor, Inc. All Rights Reserved. | ||
3 | * Copyright (C) 2008 by Sascha Hauer <kernel@pengutronix.de> | ||
4 | * | ||
5 | * This program is free software; you can redistribute it and/or | ||
6 | * modify it under the terms of the GNU General Public License | ||
7 | * as published by the Free Software Foundation; either version 2 | ||
8 | * of the License, or (at your option) any later version. | ||
9 | * This program is distributed in the hope that it will be useful, | ||
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
12 | * GNU General Public License for more details. | ||
13 | * | ||
14 | * You should have received a copy of the GNU General Public License | ||
15 | * along with this program; if not, write to the Free Software | ||
16 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, | ||
17 | * MA 02110-1301, USA. | ||
18 | */ | ||
19 | |||
20 | #include <linux/module.h> | ||
21 | #include <linux/spinlock.h> | ||
22 | #include <linux/delay.h> | ||
23 | #include <linux/clk.h> | ||
24 | #include <linux/err.h> | ||
25 | #include <linux/io.h> | ||
26 | #include <linux/clkdev.h> | ||
27 | |||
28 | #include <asm/div64.h> | ||
29 | |||
30 | #include <mach/clock.h> | ||
31 | #include <mach/hardware.h> | ||
32 | #include <mach/mx31.h> | ||
33 | #include <mach/common.h> | ||
34 | |||
35 | #include "crmregs-imx3.h" | ||
36 | |||
37 | #define PRE_DIV_MIN_FREQ 10000000 /* Minimum Frequency after Predivider */ | ||
38 | |||
39 | static void __calc_pre_post_dividers(u32 div, u32 *pre, u32 *post) | ||
40 | { | ||
41 | u32 min_pre, temp_pre, old_err, err; | ||
42 | |||
43 | if (div >= 512) { | ||
44 | *pre = 8; | ||
45 | *post = 64; | ||
46 | } else if (div >= 64) { | ||
47 | min_pre = (div - 1) / 64 + 1; | ||
48 | old_err = 8; | ||
49 | for (temp_pre = 8; temp_pre >= min_pre; temp_pre--) { | ||
50 | err = div % temp_pre; | ||
51 | if (err == 0) { | ||
52 | *pre = temp_pre; | ||
53 | break; | ||
54 | } | ||
55 | err = temp_pre - err; | ||
56 | if (err < old_err) { | ||
57 | old_err = err; | ||
58 | *pre = temp_pre; | ||
59 | } | ||
60 | } | ||
61 | *post = (div + *pre - 1) / *pre; | ||
62 | } else if (div <= 8) { | ||
63 | *pre = div; | ||
64 | *post = 1; | ||
65 | } else { | ||
66 | *pre = 1; | ||
67 | *post = div; | ||
68 | } | ||
69 | } | ||
70 | |||
71 | static struct clk mcu_pll_clk; | ||
72 | static struct clk serial_pll_clk; | ||
73 | static struct clk ipg_clk; | ||
74 | static struct clk ckih_clk; | ||
75 | |||
76 | static int cgr_enable(struct clk *clk) | ||
77 | { | ||
78 | u32 reg; | ||
79 | |||
80 | if (!clk->enable_reg) | ||
81 | return 0; | ||
82 | |||
83 | reg = __raw_readl(clk->enable_reg); | ||
84 | reg |= 3 << clk->enable_shift; | ||
85 | __raw_writel(reg, clk->enable_reg); | ||
86 | |||
87 | return 0; | ||
88 | } | ||
89 | |||
90 | static void cgr_disable(struct clk *clk) | ||
91 | { | ||
92 | u32 reg; | ||
93 | |||
94 | if (!clk->enable_reg) | ||
95 | return; | ||
96 | |||
97 | reg = __raw_readl(clk->enable_reg); | ||
98 | reg &= ~(3 << clk->enable_shift); | ||
99 | |||
100 | /* special case for EMI clock */ | ||
101 | if (clk->enable_reg == MXC_CCM_CGR2 && clk->enable_shift == 8) | ||
102 | reg |= (1 << clk->enable_shift); | ||
103 | |||
104 | __raw_writel(reg, clk->enable_reg); | ||
105 | } | ||
106 | |||
107 | static unsigned long pll_ref_get_rate(void) | ||
108 | { | ||
109 | unsigned long ccmr; | ||
110 | unsigned int prcs; | ||
111 | |||
112 | ccmr = __raw_readl(MXC_CCM_CCMR); | ||
113 | prcs = (ccmr & MXC_CCM_CCMR_PRCS_MASK) >> MXC_CCM_CCMR_PRCS_OFFSET; | ||
114 | if (prcs == 0x1) | ||
115 | return CKIL_CLK_FREQ * 1024; | ||
116 | else | ||
117 | return clk_get_rate(&ckih_clk); | ||
118 | } | ||
119 | |||
120 | static unsigned long usb_pll_get_rate(struct clk *clk) | ||
121 | { | ||
122 | unsigned long reg; | ||
123 | |||
124 | reg = __raw_readl(MXC_CCM_UPCTL); | ||
125 | |||
126 | return mxc_decode_pll(reg, pll_ref_get_rate()); | ||
127 | } | ||
128 | |||
129 | static unsigned long serial_pll_get_rate(struct clk *clk) | ||
130 | { | ||
131 | unsigned long reg; | ||
132 | |||
133 | reg = __raw_readl(MXC_CCM_SRPCTL); | ||
134 | |||
135 | return mxc_decode_pll(reg, pll_ref_get_rate()); | ||
136 | } | ||
137 | |||
138 | static unsigned long mcu_pll_get_rate(struct clk *clk) | ||
139 | { | ||
140 | unsigned long reg, ccmr; | ||
141 | |||
142 | ccmr = __raw_readl(MXC_CCM_CCMR); | ||
143 | |||
144 | if (!(ccmr & MXC_CCM_CCMR_MPE) || (ccmr & MXC_CCM_CCMR_MDS)) | ||
145 | return clk_get_rate(&ckih_clk); | ||
146 | |||
147 | reg = __raw_readl(MXC_CCM_MPCTL); | ||
148 | |||
149 | return mxc_decode_pll(reg, pll_ref_get_rate()); | ||
150 | } | ||
151 | |||
152 | static int usb_pll_enable(struct clk *clk) | ||
153 | { | ||
154 | u32 reg; | ||
155 | |||
156 | reg = __raw_readl(MXC_CCM_CCMR); | ||
157 | reg |= MXC_CCM_CCMR_UPE; | ||
158 | __raw_writel(reg, MXC_CCM_CCMR); | ||
159 | |||
160 | /* No lock bit on MX31, so using max time from spec */ | ||
161 | udelay(80); | ||
162 | |||
163 | return 0; | ||
164 | } | ||
165 | |||
166 | static void usb_pll_disable(struct clk *clk) | ||
167 | { | ||
168 | u32 reg; | ||
169 | |||
170 | reg = __raw_readl(MXC_CCM_CCMR); | ||
171 | reg &= ~MXC_CCM_CCMR_UPE; | ||
172 | __raw_writel(reg, MXC_CCM_CCMR); | ||
173 | } | ||
174 | |||
175 | static int serial_pll_enable(struct clk *clk) | ||
176 | { | ||
177 | u32 reg; | ||
178 | |||
179 | reg = __raw_readl(MXC_CCM_CCMR); | ||
180 | reg |= MXC_CCM_CCMR_SPE; | ||
181 | __raw_writel(reg, MXC_CCM_CCMR); | ||
182 | |||
183 | /* No lock bit on MX31, so using max time from spec */ | ||
184 | udelay(80); | ||
185 | |||
186 | return 0; | ||
187 | } | ||
188 | |||
189 | static void serial_pll_disable(struct clk *clk) | ||
190 | { | ||
191 | u32 reg; | ||
192 | |||
193 | reg = __raw_readl(MXC_CCM_CCMR); | ||
194 | reg &= ~MXC_CCM_CCMR_SPE; | ||
195 | __raw_writel(reg, MXC_CCM_CCMR); | ||
196 | } | ||
197 | |||
198 | #define PDR0(mask, off) ((__raw_readl(MXC_CCM_PDR0) & mask) >> off) | ||
199 | #define PDR1(mask, off) ((__raw_readl(MXC_CCM_PDR1) & mask) >> off) | ||
200 | #define PDR2(mask, off) ((__raw_readl(MXC_CCM_PDR2) & mask) >> off) | ||
201 | |||
202 | static unsigned long mcu_main_get_rate(struct clk *clk) | ||
203 | { | ||
204 | u32 pmcr0 = __raw_readl(MXC_CCM_PMCR0); | ||
205 | |||
206 | if ((pmcr0 & MXC_CCM_PMCR0_DFSUP1) == MXC_CCM_PMCR0_DFSUP1_SPLL) | ||
207 | return clk_get_rate(&serial_pll_clk); | ||
208 | else | ||
209 | return clk_get_rate(&mcu_pll_clk); | ||
210 | } | ||
211 | |||
212 | static unsigned long ahb_get_rate(struct clk *clk) | ||
213 | { | ||
214 | unsigned long max_pdf; | ||
215 | |||
216 | max_pdf = PDR0(MXC_CCM_PDR0_MAX_PODF_MASK, | ||
217 | MXC_CCM_PDR0_MAX_PODF_OFFSET); | ||
218 | return clk_get_rate(clk->parent) / (max_pdf + 1); | ||
219 | } | ||
220 | |||
221 | static unsigned long ipg_get_rate(struct clk *clk) | ||
222 | { | ||
223 | unsigned long ipg_pdf; | ||
224 | |||
225 | ipg_pdf = PDR0(MXC_CCM_PDR0_IPG_PODF_MASK, | ||
226 | MXC_CCM_PDR0_IPG_PODF_OFFSET); | ||
227 | return clk_get_rate(clk->parent) / (ipg_pdf + 1); | ||
228 | } | ||
229 | |||
230 | static unsigned long nfc_get_rate(struct clk *clk) | ||
231 | { | ||
232 | unsigned long nfc_pdf; | ||
233 | |||
234 | nfc_pdf = PDR0(MXC_CCM_PDR0_NFC_PODF_MASK, | ||
235 | MXC_CCM_PDR0_NFC_PODF_OFFSET); | ||
236 | return clk_get_rate(clk->parent) / (nfc_pdf + 1); | ||
237 | } | ||
238 | |||
239 | static unsigned long hsp_get_rate(struct clk *clk) | ||
240 | { | ||
241 | unsigned long hsp_pdf; | ||
242 | |||
243 | hsp_pdf = PDR0(MXC_CCM_PDR0_HSP_PODF_MASK, | ||
244 | MXC_CCM_PDR0_HSP_PODF_OFFSET); | ||
245 | return clk_get_rate(clk->parent) / (hsp_pdf + 1); | ||
246 | } | ||
247 | |||
248 | static unsigned long usb_get_rate(struct clk *clk) | ||
249 | { | ||
250 | unsigned long usb_pdf, usb_prepdf; | ||
251 | |||
252 | usb_pdf = PDR1(MXC_CCM_PDR1_USB_PODF_MASK, | ||
253 | MXC_CCM_PDR1_USB_PODF_OFFSET); | ||
254 | usb_prepdf = PDR1(MXC_CCM_PDR1_USB_PRDF_MASK, | ||
255 | MXC_CCM_PDR1_USB_PRDF_OFFSET); | ||
256 | return clk_get_rate(clk->parent) / (usb_prepdf + 1) / (usb_pdf + 1); | ||
257 | } | ||
258 | |||
259 | static unsigned long csi_get_rate(struct clk *clk) | ||
260 | { | ||
261 | u32 reg, pre, post; | ||
262 | |||
263 | reg = __raw_readl(MXC_CCM_PDR0); | ||
264 | pre = (reg & MXC_CCM_PDR0_CSI_PRDF_MASK) >> | ||
265 | MXC_CCM_PDR0_CSI_PRDF_OFFSET; | ||
266 | pre++; | ||
267 | post = (reg & MXC_CCM_PDR0_CSI_PODF_MASK) >> | ||
268 | MXC_CCM_PDR0_CSI_PODF_OFFSET; | ||
269 | post++; | ||
270 | return clk_get_rate(clk->parent) / (pre * post); | ||
271 | } | ||
272 | |||
273 | static unsigned long csi_round_rate(struct clk *clk, unsigned long rate) | ||
274 | { | ||
275 | u32 pre, post, parent = clk_get_rate(clk->parent); | ||
276 | u32 div = parent / rate; | ||
277 | |||
278 | if (parent % rate) | ||
279 | div++; | ||
280 | |||
281 | __calc_pre_post_dividers(div, &pre, &post); | ||
282 | |||
283 | return parent / (pre * post); | ||
284 | } | ||
285 | |||
286 | static int csi_set_rate(struct clk *clk, unsigned long rate) | ||
287 | { | ||
288 | u32 reg, div, pre, post, parent = clk_get_rate(clk->parent); | ||
289 | |||
290 | div = parent / rate; | ||
291 | |||
292 | if ((parent / div) != rate) | ||
293 | return -EINVAL; | ||
294 | |||
295 | __calc_pre_post_dividers(div, &pre, &post); | ||
296 | |||
297 | /* Set CSI clock divider */ | ||
298 | reg = __raw_readl(MXC_CCM_PDR0) & | ||
299 | ~(MXC_CCM_PDR0_CSI_PODF_MASK | MXC_CCM_PDR0_CSI_PRDF_MASK); | ||
300 | reg |= (post - 1) << MXC_CCM_PDR0_CSI_PODF_OFFSET; | ||
301 | reg |= (pre - 1) << MXC_CCM_PDR0_CSI_PRDF_OFFSET; | ||
302 | __raw_writel(reg, MXC_CCM_PDR0); | ||
303 | |||
304 | return 0; | ||
305 | } | ||
306 | |||
307 | static unsigned long ssi1_get_rate(struct clk *clk) | ||
308 | { | ||
309 | unsigned long ssi1_pdf, ssi1_prepdf; | ||
310 | |||
311 | ssi1_pdf = PDR1(MXC_CCM_PDR1_SSI1_PODF_MASK, | ||
312 | MXC_CCM_PDR1_SSI1_PODF_OFFSET); | ||
313 | ssi1_prepdf = PDR1(MXC_CCM_PDR1_SSI1_PRE_PODF_MASK, | ||
314 | MXC_CCM_PDR1_SSI1_PRE_PODF_OFFSET); | ||
315 | return clk_get_rate(clk->parent) / (ssi1_prepdf + 1) / (ssi1_pdf + 1); | ||
316 | } | ||
317 | |||
318 | static unsigned long ssi2_get_rate(struct clk *clk) | ||
319 | { | ||
320 | unsigned long ssi2_pdf, ssi2_prepdf; | ||
321 | |||
322 | ssi2_pdf = PDR1(MXC_CCM_PDR1_SSI2_PODF_MASK, | ||
323 | MXC_CCM_PDR1_SSI2_PODF_OFFSET); | ||
324 | ssi2_prepdf = PDR1(MXC_CCM_PDR1_SSI2_PRE_PODF_MASK, | ||
325 | MXC_CCM_PDR1_SSI2_PRE_PODF_OFFSET); | ||
326 | return clk_get_rate(clk->parent) / (ssi2_prepdf + 1) / (ssi2_pdf + 1); | ||
327 | } | ||
328 | |||
329 | static unsigned long firi_get_rate(struct clk *clk) | ||
330 | { | ||
331 | unsigned long firi_pdf, firi_prepdf; | ||
332 | |||
333 | firi_pdf = PDR1(MXC_CCM_PDR1_FIRI_PODF_MASK, | ||
334 | MXC_CCM_PDR1_FIRI_PODF_OFFSET); | ||
335 | firi_prepdf = PDR1(MXC_CCM_PDR1_FIRI_PRE_PODF_MASK, | ||
336 | MXC_CCM_PDR1_FIRI_PRE_PODF_OFFSET); | ||
337 | return clk_get_rate(clk->parent) / (firi_prepdf + 1) / (firi_pdf + 1); | ||
338 | } | ||
339 | |||
340 | static unsigned long firi_round_rate(struct clk *clk, unsigned long rate) | ||
341 | { | ||
342 | u32 pre, post; | ||
343 | u32 parent = clk_get_rate(clk->parent); | ||
344 | u32 div = parent / rate; | ||
345 | |||
346 | if (parent % rate) | ||
347 | div++; | ||
348 | |||
349 | __calc_pre_post_dividers(div, &pre, &post); | ||
350 | |||
351 | return parent / (pre * post); | ||
352 | |||
353 | } | ||
354 | |||
355 | static int firi_set_rate(struct clk *clk, unsigned long rate) | ||
356 | { | ||
357 | u32 reg, div, pre, post, parent = clk_get_rate(clk->parent); | ||
358 | |||
359 | div = parent / rate; | ||
360 | |||
361 | if ((parent / div) != rate) | ||
362 | return -EINVAL; | ||
363 | |||
364 | __calc_pre_post_dividers(div, &pre, &post); | ||
365 | |||
366 | /* Set FIRI clock divider */ | ||
367 | reg = __raw_readl(MXC_CCM_PDR1) & | ||
368 | ~(MXC_CCM_PDR1_FIRI_PODF_MASK | MXC_CCM_PDR1_FIRI_PRE_PODF_MASK); | ||
369 | reg |= (pre - 1) << MXC_CCM_PDR1_FIRI_PRE_PODF_OFFSET; | ||
370 | reg |= (post - 1) << MXC_CCM_PDR1_FIRI_PODF_OFFSET; | ||
371 | __raw_writel(reg, MXC_CCM_PDR1); | ||
372 | |||
373 | return 0; | ||
374 | } | ||
375 | |||
376 | static unsigned long mbx_get_rate(struct clk *clk) | ||
377 | { | ||
378 | return clk_get_rate(clk->parent) / 2; | ||
379 | } | ||
380 | |||
381 | static unsigned long mstick1_get_rate(struct clk *clk) | ||
382 | { | ||
383 | unsigned long msti_pdf; | ||
384 | |||
385 | msti_pdf = PDR2(MXC_CCM_PDR2_MST1_PDF_MASK, | ||
386 | MXC_CCM_PDR2_MST1_PDF_OFFSET); | ||
387 | return clk_get_rate(clk->parent) / (msti_pdf + 1); | ||
388 | } | ||
389 | |||
390 | static unsigned long mstick2_get_rate(struct clk *clk) | ||
391 | { | ||
392 | unsigned long msti_pdf; | ||
393 | |||
394 | msti_pdf = PDR2(MXC_CCM_PDR2_MST2_PDF_MASK, | ||
395 | MXC_CCM_PDR2_MST2_PDF_OFFSET); | ||
396 | return clk_get_rate(clk->parent) / (msti_pdf + 1); | ||
397 | } | ||
398 | |||
399 | static unsigned long ckih_rate; | ||
400 | |||
401 | static unsigned long clk_ckih_get_rate(struct clk *clk) | ||
402 | { | ||
403 | return ckih_rate; | ||
404 | } | ||
405 | |||
406 | static unsigned long clk_ckil_get_rate(struct clk *clk) | ||
407 | { | ||
408 | return CKIL_CLK_FREQ; | ||
409 | } | ||
410 | |||
411 | static struct clk ckih_clk = { | ||
412 | .get_rate = clk_ckih_get_rate, | ||
413 | }; | ||
414 | |||
415 | static struct clk mcu_pll_clk = { | ||
416 | .parent = &ckih_clk, | ||
417 | .get_rate = mcu_pll_get_rate, | ||
418 | }; | ||
419 | |||
420 | static struct clk mcu_main_clk = { | ||
421 | .parent = &mcu_pll_clk, | ||
422 | .get_rate = mcu_main_get_rate, | ||
423 | }; | ||
424 | |||
425 | static struct clk serial_pll_clk = { | ||
426 | .parent = &ckih_clk, | ||
427 | .get_rate = serial_pll_get_rate, | ||
428 | .enable = serial_pll_enable, | ||
429 | .disable = serial_pll_disable, | ||
430 | }; | ||
431 | |||
432 | static struct clk usb_pll_clk = { | ||
433 | .parent = &ckih_clk, | ||
434 | .get_rate = usb_pll_get_rate, | ||
435 | .enable = usb_pll_enable, | ||
436 | .disable = usb_pll_disable, | ||
437 | }; | ||
438 | |||
439 | static struct clk ahb_clk = { | ||
440 | .parent = &mcu_main_clk, | ||
441 | .get_rate = ahb_get_rate, | ||
442 | }; | ||
443 | |||
444 | #define DEFINE_CLOCK(name, i, er, es, gr, s, p) \ | ||
445 | static struct clk name = { \ | ||
446 | .id = i, \ | ||
447 | .enable_reg = er, \ | ||
448 | .enable_shift = es, \ | ||
449 | .get_rate = gr, \ | ||
450 | .enable = cgr_enable, \ | ||
451 | .disable = cgr_disable, \ | ||
452 | .secondary = s, \ | ||
453 | .parent = p, \ | ||
454 | } | ||
455 | |||
456 | #define DEFINE_CLOCK1(name, i, er, es, getsetround, s, p) \ | ||
457 | static struct clk name = { \ | ||
458 | .id = i, \ | ||
459 | .enable_reg = er, \ | ||
460 | .enable_shift = es, \ | ||
461 | .get_rate = getsetround##_get_rate, \ | ||
462 | .set_rate = getsetround##_set_rate, \ | ||
463 | .round_rate = getsetround##_round_rate, \ | ||
464 | .enable = cgr_enable, \ | ||
465 | .disable = cgr_disable, \ | ||
466 | .secondary = s, \ | ||
467 | .parent = p, \ | ||
468 | } | ||
469 | |||
470 | DEFINE_CLOCK(perclk_clk, 0, NULL, 0, NULL, NULL, &ipg_clk); | ||
471 | DEFINE_CLOCK(ckil_clk, 0, NULL, 0, clk_ckil_get_rate, NULL, NULL); | ||
472 | |||
473 | DEFINE_CLOCK(sdhc1_clk, 0, MXC_CCM_CGR0, 0, NULL, NULL, &perclk_clk); | ||
474 | DEFINE_CLOCK(sdhc2_clk, 1, MXC_CCM_CGR0, 2, NULL, NULL, &perclk_clk); | ||
475 | DEFINE_CLOCK(gpt_clk, 0, MXC_CCM_CGR0, 4, NULL, NULL, &perclk_clk); | ||
476 | DEFINE_CLOCK(epit1_clk, 0, MXC_CCM_CGR0, 6, NULL, NULL, &perclk_clk); | ||
477 | DEFINE_CLOCK(epit2_clk, 1, MXC_CCM_CGR0, 8, NULL, NULL, &perclk_clk); | ||
478 | DEFINE_CLOCK(iim_clk, 0, MXC_CCM_CGR0, 10, NULL, NULL, &ipg_clk); | ||
479 | DEFINE_CLOCK(pata_clk, 0, MXC_CCM_CGR0, 12, NULL, NULL, &ipg_clk); | ||
480 | DEFINE_CLOCK(sdma_clk1, 0, MXC_CCM_CGR0, 14, NULL, NULL, &ahb_clk); | ||
481 | DEFINE_CLOCK(cspi3_clk, 2, MXC_CCM_CGR0, 16, NULL, NULL, &ipg_clk); | ||
482 | DEFINE_CLOCK(rng_clk, 0, MXC_CCM_CGR0, 18, NULL, NULL, &ipg_clk); | ||
483 | DEFINE_CLOCK(uart1_clk, 0, MXC_CCM_CGR0, 20, NULL, NULL, &perclk_clk); | ||
484 | DEFINE_CLOCK(uart2_clk, 1, MXC_CCM_CGR0, 22, NULL, NULL, &perclk_clk); | ||
485 | DEFINE_CLOCK(ssi1_clk, 0, MXC_CCM_CGR0, 24, ssi1_get_rate, NULL, &serial_pll_clk); | ||
486 | DEFINE_CLOCK(i2c1_clk, 0, MXC_CCM_CGR0, 26, NULL, NULL, &perclk_clk); | ||
487 | DEFINE_CLOCK(i2c2_clk, 1, MXC_CCM_CGR0, 28, NULL, NULL, &perclk_clk); | ||
488 | DEFINE_CLOCK(i2c3_clk, 2, MXC_CCM_CGR0, 30, NULL, NULL, &perclk_clk); | ||
489 | |||
490 | DEFINE_CLOCK(mpeg4_clk, 0, MXC_CCM_CGR1, 0, NULL, NULL, &ahb_clk); | ||
491 | DEFINE_CLOCK(mstick1_clk, 0, MXC_CCM_CGR1, 2, mstick1_get_rate, NULL, &usb_pll_clk); | ||
492 | DEFINE_CLOCK(mstick2_clk, 1, MXC_CCM_CGR1, 4, mstick2_get_rate, NULL, &usb_pll_clk); | ||
493 | DEFINE_CLOCK1(csi_clk, 0, MXC_CCM_CGR1, 6, csi, NULL, &serial_pll_clk); | ||
494 | DEFINE_CLOCK(rtc_clk, 0, MXC_CCM_CGR1, 8, NULL, NULL, &ckil_clk); | ||
495 | DEFINE_CLOCK(wdog_clk, 0, MXC_CCM_CGR1, 10, NULL, NULL, &ipg_clk); | ||
496 | DEFINE_CLOCK(pwm_clk, 0, MXC_CCM_CGR1, 12, NULL, NULL, &perclk_clk); | ||
497 | DEFINE_CLOCK(usb_clk2, 0, MXC_CCM_CGR1, 18, usb_get_rate, NULL, &ahb_clk); | ||
498 | DEFINE_CLOCK(kpp_clk, 0, MXC_CCM_CGR1, 20, NULL, NULL, &ipg_clk); | ||
499 | DEFINE_CLOCK(ipu_clk, 0, MXC_CCM_CGR1, 22, hsp_get_rate, NULL, &mcu_main_clk); | ||
500 | DEFINE_CLOCK(uart3_clk, 2, MXC_CCM_CGR1, 24, NULL, NULL, &perclk_clk); | ||
501 | DEFINE_CLOCK(uart4_clk, 3, MXC_CCM_CGR1, 26, NULL, NULL, &perclk_clk); | ||
502 | DEFINE_CLOCK(uart5_clk, 4, MXC_CCM_CGR1, 28, NULL, NULL, &perclk_clk); | ||
503 | DEFINE_CLOCK(owire_clk, 0, MXC_CCM_CGR1, 30, NULL, NULL, &perclk_clk); | ||
504 | |||
505 | DEFINE_CLOCK(ssi2_clk, 1, MXC_CCM_CGR2, 0, ssi2_get_rate, NULL, &serial_pll_clk); | ||
506 | DEFINE_CLOCK(cspi1_clk, 0, MXC_CCM_CGR2, 2, NULL, NULL, &ipg_clk); | ||
507 | DEFINE_CLOCK(cspi2_clk, 1, MXC_CCM_CGR2, 4, NULL, NULL, &ipg_clk); | ||
508 | DEFINE_CLOCK(mbx_clk, 0, MXC_CCM_CGR2, 6, mbx_get_rate, NULL, &ahb_clk); | ||
509 | DEFINE_CLOCK(emi_clk, 0, MXC_CCM_CGR2, 8, NULL, NULL, &ahb_clk); | ||
510 | DEFINE_CLOCK(rtic_clk, 0, MXC_CCM_CGR2, 10, NULL, NULL, &ahb_clk); | ||
511 | DEFINE_CLOCK1(firi_clk, 0, MXC_CCM_CGR2, 12, firi, NULL, &usb_pll_clk); | ||
512 | |||
513 | DEFINE_CLOCK(sdma_clk2, 0, NULL, 0, NULL, NULL, &ipg_clk); | ||
514 | DEFINE_CLOCK(usb_clk1, 0, NULL, 0, usb_get_rate, NULL, &usb_pll_clk); | ||
515 | DEFINE_CLOCK(nfc_clk, 0, NULL, 0, nfc_get_rate, NULL, &ahb_clk); | ||
516 | DEFINE_CLOCK(scc_clk, 0, NULL, 0, NULL, NULL, &ipg_clk); | ||
517 | DEFINE_CLOCK(ipg_clk, 0, NULL, 0, ipg_get_rate, NULL, &ahb_clk); | ||
518 | |||
519 | #define _REGISTER_CLOCK(d, n, c) \ | ||
520 | { \ | ||
521 | .dev_id = d, \ | ||
522 | .con_id = n, \ | ||
523 | .clk = &c, \ | ||
524 | }, | ||
525 | |||
526 | static struct clk_lookup lookups[] = { | ||
527 | _REGISTER_CLOCK(NULL, "emi", emi_clk) | ||
528 | _REGISTER_CLOCK("imx31-cspi.0", NULL, cspi1_clk) | ||
529 | _REGISTER_CLOCK("imx31-cspi.1", NULL, cspi2_clk) | ||
530 | _REGISTER_CLOCK("imx31-cspi.2", NULL, cspi3_clk) | ||
531 | _REGISTER_CLOCK(NULL, "gpt", gpt_clk) | ||
532 | _REGISTER_CLOCK(NULL, "pwm", pwm_clk) | ||
533 | _REGISTER_CLOCK("imx2-wdt.0", NULL, wdog_clk) | ||
534 | _REGISTER_CLOCK(NULL, "rtc", rtc_clk) | ||
535 | _REGISTER_CLOCK(NULL, "epit", epit1_clk) | ||
536 | _REGISTER_CLOCK(NULL, "epit", epit2_clk) | ||
537 | _REGISTER_CLOCK("mxc_nand.0", NULL, nfc_clk) | ||
538 | _REGISTER_CLOCK("ipu-core", NULL, ipu_clk) | ||
539 | _REGISTER_CLOCK("mx3_sdc_fb", NULL, ipu_clk) | ||
540 | _REGISTER_CLOCK(NULL, "kpp", kpp_clk) | ||
541 | _REGISTER_CLOCK("mxc-ehci.0", "usb", usb_clk1) | ||
542 | _REGISTER_CLOCK("mxc-ehci.0", "usb_ahb", usb_clk2) | ||
543 | _REGISTER_CLOCK("mxc-ehci.1", "usb", usb_clk1) | ||
544 | _REGISTER_CLOCK("mxc-ehci.1", "usb_ahb", usb_clk2) | ||
545 | _REGISTER_CLOCK("mxc-ehci.2", "usb", usb_clk1) | ||
546 | _REGISTER_CLOCK("mxc-ehci.2", "usb_ahb", usb_clk2) | ||
547 | _REGISTER_CLOCK("fsl-usb2-udc", "usb", usb_clk1) | ||
548 | _REGISTER_CLOCK("fsl-usb2-udc", "usb_ahb", usb_clk2) | ||
549 | _REGISTER_CLOCK("mx3-camera.0", NULL, csi_clk) | ||
550 | /* i.mx31 has the i.mx21 type uart */ | ||
551 | _REGISTER_CLOCK("imx21-uart.0", NULL, uart1_clk) | ||
552 | _REGISTER_CLOCK("imx21-uart.1", NULL, uart2_clk) | ||
553 | _REGISTER_CLOCK("imx21-uart.2", NULL, uart3_clk) | ||
554 | _REGISTER_CLOCK("imx21-uart.3", NULL, uart4_clk) | ||
555 | _REGISTER_CLOCK("imx21-uart.4", NULL, uart5_clk) | ||
556 | _REGISTER_CLOCK("imx-i2c.0", NULL, i2c1_clk) | ||
557 | _REGISTER_CLOCK("imx-i2c.1", NULL, i2c2_clk) | ||
558 | _REGISTER_CLOCK("imx-i2c.2", NULL, i2c3_clk) | ||
559 | _REGISTER_CLOCK("mxc_w1.0", NULL, owire_clk) | ||
560 | _REGISTER_CLOCK("mxc-mmc.0", NULL, sdhc1_clk) | ||
561 | _REGISTER_CLOCK("mxc-mmc.1", NULL, sdhc2_clk) | ||
562 | _REGISTER_CLOCK("imx-ssi.0", NULL, ssi1_clk) | ||
563 | _REGISTER_CLOCK("imx-ssi.1", NULL, ssi2_clk) | ||
564 | _REGISTER_CLOCK(NULL, "firi", firi_clk) | ||
565 | _REGISTER_CLOCK("pata_imx", NULL, pata_clk) | ||
566 | _REGISTER_CLOCK(NULL, "rtic", rtic_clk) | ||
567 | _REGISTER_CLOCK(NULL, "rng", rng_clk) | ||
568 | _REGISTER_CLOCK("imx31-sdma", NULL, sdma_clk1) | ||
569 | _REGISTER_CLOCK(NULL, "sdma_ipg", sdma_clk2) | ||
570 | _REGISTER_CLOCK(NULL, "mstick", mstick1_clk) | ||
571 | _REGISTER_CLOCK(NULL, "mstick", mstick2_clk) | ||
572 | _REGISTER_CLOCK(NULL, "scc", scc_clk) | ||
573 | _REGISTER_CLOCK(NULL, "iim", iim_clk) | ||
574 | _REGISTER_CLOCK(NULL, "mpeg4", mpeg4_clk) | ||
575 | _REGISTER_CLOCK(NULL, "mbx", mbx_clk) | ||
576 | }; | ||
577 | |||
578 | int __init mx31_clocks_init(unsigned long fref) | ||
579 | { | ||
580 | u32 reg; | ||
581 | |||
582 | ckih_rate = fref; | ||
583 | |||
584 | clkdev_add_table(lookups, ARRAY_SIZE(lookups)); | ||
585 | |||
586 | /* change the csi_clk parent if necessary */ | ||
587 | reg = __raw_readl(MXC_CCM_CCMR); | ||
588 | if (!(reg & MXC_CCM_CCMR_CSCS)) | ||
589 | if (clk_set_parent(&csi_clk, &usb_pll_clk)) | ||
590 | pr_err("%s: error changing csi_clk parent\n", __func__); | ||
591 | |||
592 | |||
593 | /* Turn off all possible clocks */ | ||
594 | __raw_writel((3 << 4), MXC_CCM_CGR0); | ||
595 | __raw_writel(0, MXC_CCM_CGR1); | ||
596 | __raw_writel((3 << 8) | (3 << 14) | (3 << 16)| | ||
597 | 1 << 27 | 1 << 28, /* Bit 27 and 28 are not defined for | ||
598 | MX32, but still required to be set */ | ||
599 | MXC_CCM_CGR2); | ||
600 | |||
601 | /* | ||
602 | * Before turning off usb_pll make sure ipg_per_clk is generated | ||
603 | * by ipg_clk and not usb_pll. | ||
604 | */ | ||
605 | __raw_writel(__raw_readl(MXC_CCM_CCMR) | (1 << 24), MXC_CCM_CCMR); | ||
606 | |||
607 | usb_pll_disable(&usb_pll_clk); | ||
608 | |||
609 | pr_info("Clock input source is %ld\n", clk_get_rate(&ckih_clk)); | ||
610 | |||
611 | clk_enable(&gpt_clk); | ||
612 | clk_enable(&emi_clk); | ||
613 | clk_enable(&iim_clk); | ||
614 | mx31_revision(); | ||
615 | clk_disable(&iim_clk); | ||
616 | |||
617 | clk_enable(&serial_pll_clk); | ||
618 | |||
619 | if (mx31_revision() >= IMX_CHIP_REVISION_2_0) { | ||
620 | reg = __raw_readl(MXC_CCM_PMCR1); | ||
621 | /* No PLL restart on DVFS switch; enable auto EMI handshake */ | ||
622 | reg |= MXC_CCM_PMCR1_PLLRDIS | MXC_CCM_PMCR1_EMIRQ_EN; | ||
623 | __raw_writel(reg, MXC_CCM_PMCR1); | ||
624 | } | ||
625 | |||
626 | mxc_timer_init(&ipg_clk, MX31_IO_ADDRESS(MX31_GPT1_BASE_ADDR), | ||
627 | MX31_INT_GPT); | ||
628 | |||
629 | return 0; | ||
630 | } | ||
diff --git a/arch/arm/mach-imx/clock-imx35.c b/arch/arm/mach-imx/clock-imx35.c deleted file mode 100644 index e56c1a83eee3..000000000000 --- a/arch/arm/mach-imx/clock-imx35.c +++ /dev/null | |||
@@ -1,536 +0,0 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2009 by Sascha Hauer, Pengutronix | ||
3 | * | ||
4 | * This program is free software; you can redistribute it and/or | ||
5 | * modify it under the terms of the GNU General Public License | ||
6 | * as published by the Free Software Foundation; either version 2 | ||
7 | * of the License, or (at your option) any later version. | ||
8 | * This program is distributed in the hope that it will be useful, | ||
9 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
10 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
11 | * GNU General Public License for more details. | ||
12 | * | ||
13 | * You should have received a copy of the GNU General Public License | ||
14 | * along with this program; if not, write to the Free Software | ||
15 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, | ||
16 | * MA 02110-1301, USA. | ||
17 | */ | ||
18 | |||
19 | #include <linux/kernel.h> | ||
20 | #include <linux/init.h> | ||
21 | #include <linux/list.h> | ||
22 | #include <linux/clk.h> | ||
23 | #include <linux/io.h> | ||
24 | #include <linux/clkdev.h> | ||
25 | |||
26 | #include <mach/clock.h> | ||
27 | #include <mach/hardware.h> | ||
28 | #include <mach/common.h> | ||
29 | |||
30 | #include "crmregs-imx3.h" | ||
31 | |||
32 | #ifdef HAVE_SET_RATE_SUPPORT | ||
33 | static void calc_dividers(u32 div, u32 *pre, u32 *post, u32 maxpost) | ||
34 | { | ||
35 | u32 min_pre, temp_pre, old_err, err; | ||
36 | |||
37 | min_pre = (div - 1) / maxpost + 1; | ||
38 | old_err = 8; | ||
39 | |||
40 | for (temp_pre = 8; temp_pre >= min_pre; temp_pre--) { | ||
41 | if (div > (temp_pre * maxpost)) | ||
42 | break; | ||
43 | |||
44 | if (div < (temp_pre * temp_pre)) | ||
45 | continue; | ||
46 | |||
47 | err = div % temp_pre; | ||
48 | |||
49 | if (err == 0) { | ||
50 | *pre = temp_pre; | ||
51 | break; | ||
52 | } | ||
53 | |||
54 | err = temp_pre - err; | ||
55 | |||
56 | if (err < old_err) { | ||
57 | old_err = err; | ||
58 | *pre = temp_pre; | ||
59 | } | ||
60 | } | ||
61 | |||
62 | *post = (div + *pre - 1) / *pre; | ||
63 | } | ||
64 | |||
65 | /* get the best values for a 3-bit divider combined with a 6-bit divider */ | ||
66 | static void calc_dividers_3_6(u32 div, u32 *pre, u32 *post) | ||
67 | { | ||
68 | if (div >= 512) { | ||
69 | *pre = 8; | ||
70 | *post = 64; | ||
71 | } else if (div >= 64) { | ||
72 | calc_dividers(div, pre, post, 64); | ||
73 | } else if (div <= 8) { | ||
74 | *pre = div; | ||
75 | *post = 1; | ||
76 | } else { | ||
77 | *pre = 1; | ||
78 | *post = div; | ||
79 | } | ||
80 | } | ||
81 | |||
82 | /* get the best values for two cascaded 3-bit dividers */ | ||
83 | static void calc_dividers_3_3(u32 div, u32 *pre, u32 *post) | ||
84 | { | ||
85 | if (div >= 64) { | ||
86 | *pre = *post = 8; | ||
87 | } else if (div > 8) { | ||
88 | calc_dividers(div, pre, post, 8); | ||
89 | } else { | ||
90 | *pre = 1; | ||
91 | *post = div; | ||
92 | } | ||
93 | } | ||
94 | #endif | ||
95 | |||
96 | static unsigned long get_rate_mpll(void) | ||
97 | { | ||
98 | ulong mpctl = __raw_readl(MX35_CCM_MPCTL); | ||
99 | |||
100 | return mxc_decode_pll(mpctl, 24000000); | ||
101 | } | ||
102 | |||
103 | static unsigned long get_rate_ppll(void) | ||
104 | { | ||
105 | ulong ppctl = __raw_readl(MX35_CCM_PPCTL); | ||
106 | |||
107 | return mxc_decode_pll(ppctl, 24000000); | ||
108 | } | ||
109 | |||
110 | struct arm_ahb_div { | ||
111 | unsigned char arm, ahb, sel; | ||
112 | }; | ||
113 | |||
114 | static struct arm_ahb_div clk_consumer[] = { | ||
115 | { .arm = 1, .ahb = 4, .sel = 0}, | ||
116 | { .arm = 1, .ahb = 3, .sel = 1}, | ||
117 | { .arm = 2, .ahb = 2, .sel = 0}, | ||
118 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
119 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
120 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
121 | { .arm = 4, .ahb = 1, .sel = 0}, | ||
122 | { .arm = 1, .ahb = 5, .sel = 0}, | ||
123 | { .arm = 1, .ahb = 8, .sel = 0}, | ||
124 | { .arm = 1, .ahb = 6, .sel = 1}, | ||
125 | { .arm = 2, .ahb = 4, .sel = 0}, | ||
126 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
127 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
128 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
129 | { .arm = 4, .ahb = 2, .sel = 0}, | ||
130 | { .arm = 0, .ahb = 0, .sel = 0}, | ||
131 | }; | ||
132 | |||
133 | static unsigned long get_rate_arm(void) | ||
134 | { | ||
135 | unsigned long pdr0 = __raw_readl(MXC_CCM_PDR0); | ||
136 | struct arm_ahb_div *aad; | ||
137 | unsigned long fref = get_rate_mpll(); | ||
138 | |||
139 | aad = &clk_consumer[(pdr0 >> 16) & 0xf]; | ||
140 | if (aad->sel) | ||
141 | fref = fref * 3 / 4; | ||
142 | |||
143 | return fref / aad->arm; | ||
144 | } | ||
145 | |||
146 | static unsigned long get_rate_ahb(struct clk *clk) | ||
147 | { | ||
148 | unsigned long pdr0 = __raw_readl(MXC_CCM_PDR0); | ||
149 | struct arm_ahb_div *aad; | ||
150 | unsigned long fref = get_rate_arm(); | ||
151 | |||
152 | aad = &clk_consumer[(pdr0 >> 16) & 0xf]; | ||
153 | |||
154 | return fref / aad->ahb; | ||
155 | } | ||
156 | |||
157 | static unsigned long get_rate_ipg(struct clk *clk) | ||
158 | { | ||
159 | return get_rate_ahb(NULL) >> 1; | ||
160 | } | ||
161 | |||
162 | static unsigned long get_rate_uart(struct clk *clk) | ||
163 | { | ||
164 | unsigned long pdr3 = __raw_readl(MX35_CCM_PDR3); | ||
165 | unsigned long pdr4 = __raw_readl(MX35_CCM_PDR4); | ||
166 | unsigned long div = ((pdr4 >> 10) & 0x3f) + 1; | ||
167 | |||
168 | if (pdr3 & (1 << 14)) | ||
169 | return get_rate_arm() / div; | ||
170 | else | ||
171 | return get_rate_ppll() / div; | ||
172 | } | ||
173 | |||
174 | static unsigned long get_rate_sdhc(struct clk *clk) | ||
175 | { | ||
176 | unsigned long pdr3 = __raw_readl(MX35_CCM_PDR3); | ||
177 | unsigned long div, rate; | ||
178 | |||
179 | if (pdr3 & (1 << 6)) | ||
180 | rate = get_rate_arm(); | ||
181 | else | ||
182 | rate = get_rate_ppll(); | ||
183 | |||
184 | switch (clk->id) { | ||
185 | default: | ||
186 | case 0: | ||
187 | div = pdr3 & 0x3f; | ||
188 | break; | ||
189 | case 1: | ||
190 | div = (pdr3 >> 8) & 0x3f; | ||
191 | break; | ||
192 | case 2: | ||
193 | div = (pdr3 >> 16) & 0x3f; | ||
194 | break; | ||
195 | } | ||
196 | |||
197 | return rate / (div + 1); | ||
198 | } | ||
199 | |||
200 | static unsigned long get_rate_mshc(struct clk *clk) | ||
201 | { | ||
202 | unsigned long pdr1 = __raw_readl(MXC_CCM_PDR1); | ||
203 | unsigned long div1, div2, rate; | ||
204 | |||
205 | if (pdr1 & (1 << 7)) | ||
206 | rate = get_rate_arm(); | ||
207 | else | ||
208 | rate = get_rate_ppll(); | ||
209 | |||
210 | div1 = (pdr1 >> 29) & 0x7; | ||
211 | div2 = (pdr1 >> 22) & 0x3f; | ||
212 | |||
213 | return rate / ((div1 + 1) * (div2 + 1)); | ||
214 | } | ||
215 | |||
216 | static unsigned long get_rate_ssi(struct clk *clk) | ||
217 | { | ||
218 | unsigned long pdr2 = __raw_readl(MX35_CCM_PDR2); | ||
219 | unsigned long div1, div2, rate; | ||
220 | |||
221 | if (pdr2 & (1 << 6)) | ||
222 | rate = get_rate_arm(); | ||
223 | else | ||
224 | rate = get_rate_ppll(); | ||
225 | |||
226 | switch (clk->id) { | ||
227 | default: | ||
228 | case 0: | ||
229 | div1 = pdr2 & 0x3f; | ||
230 | div2 = (pdr2 >> 24) & 0x7; | ||
231 | break; | ||
232 | case 1: | ||
233 | div1 = (pdr2 >> 8) & 0x3f; | ||
234 | div2 = (pdr2 >> 27) & 0x7; | ||
235 | break; | ||
236 | } | ||
237 | |||
238 | return rate / ((div1 + 1) * (div2 + 1)); | ||
239 | } | ||
240 | |||
241 | static unsigned long get_rate_csi(struct clk *clk) | ||
242 | { | ||
243 | unsigned long pdr2 = __raw_readl(MX35_CCM_PDR2); | ||
244 | unsigned long rate; | ||
245 | |||
246 | if (pdr2 & (1 << 7)) | ||
247 | rate = get_rate_arm(); | ||
248 | else | ||
249 | rate = get_rate_ppll(); | ||
250 | |||
251 | return rate / (((pdr2 >> 16) & 0x3f) + 1); | ||
252 | } | ||
253 | |||
254 | static unsigned long get_rate_otg(struct clk *clk) | ||
255 | { | ||
256 | unsigned long pdr4 = __raw_readl(MX35_CCM_PDR4); | ||
257 | unsigned long rate; | ||
258 | |||
259 | if (pdr4 & (1 << 9)) | ||
260 | rate = get_rate_arm(); | ||
261 | else | ||
262 | rate = get_rate_ppll(); | ||
263 | |||
264 | return rate / (((pdr4 >> 22) & 0x3f) + 1); | ||
265 | } | ||
266 | |||
267 | static unsigned long get_rate_ipg_per(struct clk *clk) | ||
268 | { | ||
269 | unsigned long pdr0 = __raw_readl(MXC_CCM_PDR0); | ||
270 | unsigned long pdr4 = __raw_readl(MX35_CCM_PDR4); | ||
271 | unsigned long div; | ||
272 | |||
273 | if (pdr0 & (1 << 26)) { | ||
274 | div = (pdr4 >> 16) & 0x3f; | ||
275 | return get_rate_arm() / (div + 1); | ||
276 | } else { | ||
277 | div = (pdr0 >> 12) & 0x7; | ||
278 | return get_rate_ahb(NULL) / (div + 1); | ||
279 | } | ||
280 | } | ||
281 | |||
282 | static unsigned long get_rate_hsp(struct clk *clk) | ||
283 | { | ||
284 | unsigned long hsp_podf = (__raw_readl(MXC_CCM_PDR0) >> 20) & 0x03; | ||
285 | unsigned long fref = get_rate_mpll(); | ||
286 | |||
287 | if (fref > 400 * 1000 * 1000) { | ||
288 | switch (hsp_podf) { | ||
289 | case 0: | ||
290 | return fref >> 2; | ||
291 | case 1: | ||
292 | return fref >> 3; | ||
293 | case 2: | ||
294 | return fref / 3; | ||
295 | } | ||
296 | } else { | ||
297 | switch (hsp_podf) { | ||
298 | case 0: | ||
299 | case 2: | ||
300 | return fref / 3; | ||
301 | case 1: | ||
302 | return fref / 6; | ||
303 | } | ||
304 | } | ||
305 | |||
306 | return 0; | ||
307 | } | ||
308 | |||
309 | static int clk_cgr_enable(struct clk *clk) | ||
310 | { | ||
311 | u32 reg; | ||
312 | |||
313 | reg = __raw_readl(clk->enable_reg); | ||
314 | reg |= 3 << clk->enable_shift; | ||
315 | __raw_writel(reg, clk->enable_reg); | ||
316 | |||
317 | return 0; | ||
318 | } | ||
319 | |||
320 | static void clk_cgr_disable(struct clk *clk) | ||
321 | { | ||
322 | u32 reg; | ||
323 | |||
324 | reg = __raw_readl(clk->enable_reg); | ||
325 | reg &= ~(3 << clk->enable_shift); | ||
326 | __raw_writel(reg, clk->enable_reg); | ||
327 | } | ||
328 | |||
329 | #define DEFINE_CLOCK(name, i, er, es, gr, sr) \ | ||
330 | static struct clk name = { \ | ||
331 | .id = i, \ | ||
332 | .enable_reg = er, \ | ||
333 | .enable_shift = es, \ | ||
334 | .get_rate = gr, \ | ||
335 | .set_rate = sr, \ | ||
336 | .enable = clk_cgr_enable, \ | ||
337 | .disable = clk_cgr_disable, \ | ||
338 | } | ||
339 | |||
340 | DEFINE_CLOCK(asrc_clk, 0, MX35_CCM_CGR0, 0, NULL, NULL); | ||
341 | DEFINE_CLOCK(pata_clk, 0, MX35_CCM_CGR0, 2, get_rate_ipg, NULL); | ||
342 | /* DEFINE_CLOCK(audmux_clk, 0, MX35_CCM_CGR0, 4, NULL, NULL); */ | ||
343 | DEFINE_CLOCK(can1_clk, 0, MX35_CCM_CGR0, 6, get_rate_ipg, NULL); | ||
344 | DEFINE_CLOCK(can2_clk, 1, MX35_CCM_CGR0, 8, get_rate_ipg, NULL); | ||
345 | DEFINE_CLOCK(cspi1_clk, 0, MX35_CCM_CGR0, 10, get_rate_ipg, NULL); | ||
346 | DEFINE_CLOCK(cspi2_clk, 1, MX35_CCM_CGR0, 12, get_rate_ipg, NULL); | ||
347 | DEFINE_CLOCK(ect_clk, 0, MX35_CCM_CGR0, 14, get_rate_ipg, NULL); | ||
348 | DEFINE_CLOCK(edio_clk, 0, MX35_CCM_CGR0, 16, NULL, NULL); | ||
349 | DEFINE_CLOCK(emi_clk, 0, MX35_CCM_CGR0, 18, get_rate_ipg, NULL); | ||
350 | DEFINE_CLOCK(epit1_clk, 0, MX35_CCM_CGR0, 20, get_rate_ipg, NULL); | ||
351 | DEFINE_CLOCK(epit2_clk, 1, MX35_CCM_CGR0, 22, get_rate_ipg, NULL); | ||
352 | DEFINE_CLOCK(esai_clk, 0, MX35_CCM_CGR0, 24, NULL, NULL); | ||
353 | DEFINE_CLOCK(esdhc1_clk, 0, MX35_CCM_CGR0, 26, get_rate_sdhc, NULL); | ||
354 | DEFINE_CLOCK(esdhc2_clk, 1, MX35_CCM_CGR0, 28, get_rate_sdhc, NULL); | ||
355 | DEFINE_CLOCK(esdhc3_clk, 2, MX35_CCM_CGR0, 30, get_rate_sdhc, NULL); | ||
356 | |||
357 | DEFINE_CLOCK(fec_clk, 0, MX35_CCM_CGR1, 0, get_rate_ipg, NULL); | ||
358 | DEFINE_CLOCK(gpio1_clk, 0, MX35_CCM_CGR1, 2, NULL, NULL); | ||
359 | DEFINE_CLOCK(gpio2_clk, 1, MX35_CCM_CGR1, 4, NULL, NULL); | ||
360 | DEFINE_CLOCK(gpio3_clk, 2, MX35_CCM_CGR1, 6, NULL, NULL); | ||
361 | DEFINE_CLOCK(gpt_clk, 0, MX35_CCM_CGR1, 8, get_rate_ipg, NULL); | ||
362 | DEFINE_CLOCK(i2c1_clk, 0, MX35_CCM_CGR1, 10, get_rate_ipg_per, NULL); | ||
363 | DEFINE_CLOCK(i2c2_clk, 1, MX35_CCM_CGR1, 12, get_rate_ipg_per, NULL); | ||
364 | DEFINE_CLOCK(i2c3_clk, 2, MX35_CCM_CGR1, 14, get_rate_ipg_per, NULL); | ||
365 | DEFINE_CLOCK(iomuxc_clk, 0, MX35_CCM_CGR1, 16, NULL, NULL); | ||
366 | DEFINE_CLOCK(ipu_clk, 0, MX35_CCM_CGR1, 18, get_rate_hsp, NULL); | ||
367 | DEFINE_CLOCK(kpp_clk, 0, MX35_CCM_CGR1, 20, get_rate_ipg, NULL); | ||
368 | DEFINE_CLOCK(mlb_clk, 0, MX35_CCM_CGR1, 22, get_rate_ahb, NULL); | ||
369 | DEFINE_CLOCK(mshc_clk, 0, MX35_CCM_CGR1, 24, get_rate_mshc, NULL); | ||
370 | DEFINE_CLOCK(owire_clk, 0, MX35_CCM_CGR1, 26, get_rate_ipg_per, NULL); | ||
371 | DEFINE_CLOCK(pwm_clk, 0, MX35_CCM_CGR1, 28, get_rate_ipg_per, NULL); | ||
372 | DEFINE_CLOCK(rngc_clk, 0, MX35_CCM_CGR1, 30, get_rate_ipg, NULL); | ||
373 | |||
374 | DEFINE_CLOCK(rtc_clk, 0, MX35_CCM_CGR2, 0, get_rate_ipg, NULL); | ||
375 | DEFINE_CLOCK(rtic_clk, 0, MX35_CCM_CGR2, 2, get_rate_ahb, NULL); | ||
376 | DEFINE_CLOCK(scc_clk, 0, MX35_CCM_CGR2, 4, get_rate_ipg, NULL); | ||
377 | DEFINE_CLOCK(sdma_clk, 0, MX35_CCM_CGR2, 6, NULL, NULL); | ||
378 | DEFINE_CLOCK(spba_clk, 0, MX35_CCM_CGR2, 8, get_rate_ipg, NULL); | ||
379 | DEFINE_CLOCK(spdif_clk, 0, MX35_CCM_CGR2, 10, NULL, NULL); | ||
380 | DEFINE_CLOCK(ssi1_clk, 0, MX35_CCM_CGR2, 12, get_rate_ssi, NULL); | ||
381 | DEFINE_CLOCK(ssi2_clk, 1, MX35_CCM_CGR2, 14, get_rate_ssi, NULL); | ||
382 | DEFINE_CLOCK(uart1_clk, 0, MX35_CCM_CGR2, 16, get_rate_uart, NULL); | ||
383 | DEFINE_CLOCK(uart2_clk, 1, MX35_CCM_CGR2, 18, get_rate_uart, NULL); | ||
384 | DEFINE_CLOCK(uart3_clk, 2, MX35_CCM_CGR2, 20, get_rate_uart, NULL); | ||
385 | DEFINE_CLOCK(usbotg_clk, 0, MX35_CCM_CGR2, 22, get_rate_otg, NULL); | ||
386 | DEFINE_CLOCK(wdog_clk, 0, MX35_CCM_CGR2, 24, NULL, NULL); | ||
387 | DEFINE_CLOCK(max_clk, 0, MX35_CCM_CGR2, 26, NULL, NULL); | ||
388 | DEFINE_CLOCK(audmux_clk, 0, MX35_CCM_CGR2, 30, NULL, NULL); | ||
389 | |||
390 | DEFINE_CLOCK(csi_clk, 0, MX35_CCM_CGR3, 0, get_rate_csi, NULL); | ||
391 | DEFINE_CLOCK(iim_clk, 0, MX35_CCM_CGR3, 2, NULL, NULL); | ||
392 | DEFINE_CLOCK(gpu2d_clk, 0, MX35_CCM_CGR3, 4, NULL, NULL); | ||
393 | |||
394 | DEFINE_CLOCK(usbahb_clk, 0, 0, 0, get_rate_ahb, NULL); | ||
395 | |||
396 | static int clk_dummy_enable(struct clk *clk) | ||
397 | { | ||
398 | return 0; | ||
399 | } | ||
400 | |||
401 | static void clk_dummy_disable(struct clk *clk) | ||
402 | { | ||
403 | } | ||
404 | |||
405 | static unsigned long get_rate_nfc(struct clk *clk) | ||
406 | { | ||
407 | unsigned long div1; | ||
408 | |||
409 | div1 = (__raw_readl(MX35_CCM_PDR4) >> 28) + 1; | ||
410 | |||
411 | return get_rate_ahb(NULL) / div1; | ||
412 | } | ||
413 | |||
414 | /* NAND Controller: It seems it can't be disabled */ | ||
415 | static struct clk nfc_clk = { | ||
416 | .id = 0, | ||
417 | .enable_reg = 0, | ||
418 | .enable_shift = 0, | ||
419 | .get_rate = get_rate_nfc, | ||
420 | .set_rate = NULL, /* set_rate_nfc, */ | ||
421 | .enable = clk_dummy_enable, | ||
422 | .disable = clk_dummy_disable | ||
423 | }; | ||
424 | |||
425 | #define _REGISTER_CLOCK(d, n, c) \ | ||
426 | { \ | ||
427 | .dev_id = d, \ | ||
428 | .con_id = n, \ | ||
429 | .clk = &c, \ | ||
430 | }, | ||
431 | |||
432 | static struct clk_lookup lookups[] = { | ||
433 | _REGISTER_CLOCK(NULL, "asrc", asrc_clk) | ||
434 | _REGISTER_CLOCK("pata_imx", NULL, pata_clk) | ||
435 | _REGISTER_CLOCK("flexcan.0", NULL, can1_clk) | ||
436 | _REGISTER_CLOCK("flexcan.1", NULL, can2_clk) | ||
437 | _REGISTER_CLOCK("imx35-cspi.0", NULL, cspi1_clk) | ||
438 | _REGISTER_CLOCK("imx35-cspi.1", NULL, cspi2_clk) | ||
439 | _REGISTER_CLOCK(NULL, "ect", ect_clk) | ||
440 | _REGISTER_CLOCK(NULL, "edio", edio_clk) | ||
441 | _REGISTER_CLOCK(NULL, "emi", emi_clk) | ||
442 | _REGISTER_CLOCK("imx-epit.0", NULL, epit1_clk) | ||
443 | _REGISTER_CLOCK("imx-epit.1", NULL, epit2_clk) | ||
444 | _REGISTER_CLOCK(NULL, "esai", esai_clk) | ||
445 | _REGISTER_CLOCK("sdhci-esdhc-imx35.0", NULL, esdhc1_clk) | ||
446 | _REGISTER_CLOCK("sdhci-esdhc-imx35.1", NULL, esdhc2_clk) | ||
447 | _REGISTER_CLOCK("sdhci-esdhc-imx35.2", NULL, esdhc3_clk) | ||
448 | /* i.mx35 has the i.mx27 type fec */ | ||
449 | _REGISTER_CLOCK("imx27-fec.0", NULL, fec_clk) | ||
450 | _REGISTER_CLOCK(NULL, "gpio", gpio1_clk) | ||
451 | _REGISTER_CLOCK(NULL, "gpio", gpio2_clk) | ||
452 | _REGISTER_CLOCK(NULL, "gpio", gpio3_clk) | ||
453 | _REGISTER_CLOCK("gpt.0", NULL, gpt_clk) | ||
454 | _REGISTER_CLOCK("imx-i2c.0", NULL, i2c1_clk) | ||
455 | _REGISTER_CLOCK("imx-i2c.1", NULL, i2c2_clk) | ||
456 | _REGISTER_CLOCK("imx-i2c.2", NULL, i2c3_clk) | ||
457 | _REGISTER_CLOCK(NULL, "iomuxc", iomuxc_clk) | ||
458 | _REGISTER_CLOCK("ipu-core", NULL, ipu_clk) | ||
459 | _REGISTER_CLOCK("mx3_sdc_fb", NULL, ipu_clk) | ||
460 | _REGISTER_CLOCK(NULL, "kpp", kpp_clk) | ||
461 | _REGISTER_CLOCK(NULL, "mlb", mlb_clk) | ||
462 | _REGISTER_CLOCK(NULL, "mshc", mshc_clk) | ||
463 | _REGISTER_CLOCK("mxc_w1", NULL, owire_clk) | ||
464 | _REGISTER_CLOCK(NULL, "pwm", pwm_clk) | ||
465 | _REGISTER_CLOCK(NULL, "rngc", rngc_clk) | ||
466 | _REGISTER_CLOCK(NULL, "rtc", rtc_clk) | ||
467 | _REGISTER_CLOCK(NULL, "rtic", rtic_clk) | ||
468 | _REGISTER_CLOCK(NULL, "scc", scc_clk) | ||
469 | _REGISTER_CLOCK("imx35-sdma", NULL, sdma_clk) | ||
470 | _REGISTER_CLOCK(NULL, "spba", spba_clk) | ||
471 | _REGISTER_CLOCK(NULL, "spdif", spdif_clk) | ||
472 | _REGISTER_CLOCK("imx-ssi.0", NULL, ssi1_clk) | ||
473 | _REGISTER_CLOCK("imx-ssi.1", NULL, ssi2_clk) | ||
474 | /* i.mx35 has the i.mx21 type uart */ | ||
475 | _REGISTER_CLOCK("imx21-uart.0", NULL, uart1_clk) | ||
476 | _REGISTER_CLOCK("imx21-uart.1", NULL, uart2_clk) | ||
477 | _REGISTER_CLOCK("imx21-uart.2", NULL, uart3_clk) | ||
478 | _REGISTER_CLOCK("mxc-ehci.0", "usb", usbotg_clk) | ||
479 | _REGISTER_CLOCK("mxc-ehci.1", "usb", usbotg_clk) | ||
480 | _REGISTER_CLOCK("mxc-ehci.2", "usb", usbotg_clk) | ||
481 | _REGISTER_CLOCK("fsl-usb2-udc", "usb", usbotg_clk) | ||
482 | _REGISTER_CLOCK("fsl-usb2-udc", "usb_ahb", usbahb_clk) | ||
483 | _REGISTER_CLOCK("imx2-wdt.0", NULL, wdog_clk) | ||
484 | _REGISTER_CLOCK(NULL, "max", max_clk) | ||
485 | _REGISTER_CLOCK(NULL, "audmux", audmux_clk) | ||
486 | _REGISTER_CLOCK("mx3-camera.0", NULL, csi_clk) | ||
487 | _REGISTER_CLOCK(NULL, "iim", iim_clk) | ||
488 | _REGISTER_CLOCK(NULL, "gpu2d", gpu2d_clk) | ||
489 | _REGISTER_CLOCK("mxc_nand.0", NULL, nfc_clk) | ||
490 | }; | ||
491 | |||
492 | int __init mx35_clocks_init() | ||
493 | { | ||
494 | unsigned int cgr2 = 3 << 26; | ||
495 | |||
496 | #if defined(CONFIG_DEBUG_LL) && !defined(CONFIG_DEBUG_ICEDCC) | ||
497 | cgr2 |= 3 << 16; | ||
498 | #endif | ||
499 | |||
500 | clkdev_add_table(lookups, ARRAY_SIZE(lookups)); | ||
501 | |||
502 | /* Turn off all clocks except the ones we need to survive, namely: | ||
503 | * EMI, GPIO1/2/3, GPT, IOMUX, MAX and eventually uart | ||
504 | */ | ||
505 | __raw_writel((3 << 18), MX35_CCM_CGR0); | ||
506 | __raw_writel((3 << 2) | (3 << 4) | (3 << 6) | (3 << 8) | (3 << 16), | ||
507 | MX35_CCM_CGR1); | ||
508 | __raw_writel(cgr2, MX35_CCM_CGR2); | ||
509 | __raw_writel(0, MX35_CCM_CGR3); | ||
510 | |||
511 | clk_enable(&iim_clk); | ||
512 | imx_print_silicon_rev("i.MX35", mx35_revision()); | ||
513 | clk_disable(&iim_clk); | ||
514 | |||
515 | /* | ||
516 | * Check if we came up in internal boot mode. If yes, we need some | ||
517 | * extra clocks turned on, otherwise the MX35 boot ROM code will | ||
518 | * hang after a watchdog reset. | ||
519 | */ | ||
520 | if (!(__raw_readl(MX35_CCM_RCSR) & (3 << 10))) { | ||
521 | /* Additionally turn on UART1, SCC, and IIM clocks */ | ||
522 | clk_enable(&iim_clk); | ||
523 | clk_enable(&uart1_clk); | ||
524 | clk_enable(&scc_clk); | ||
525 | } | ||
526 | |||
527 | #ifdef CONFIG_MXC_USE_EPIT | ||
528 | epit_timer_init(&epit1_clk, | ||
529 | MX35_IO_ADDRESS(MX35_EPIT1_BASE_ADDR), MX35_INT_EPIT1); | ||
530 | #else | ||
531 | mxc_timer_init(&gpt_clk, | ||
532 | MX35_IO_ADDRESS(MX35_GPT1_BASE_ADDR), MX35_INT_GPT); | ||
533 | #endif | ||
534 | |||
535 | return 0; | ||
536 | } | ||
diff --git a/arch/arm/mach-imx/clock-imx6q.c b/arch/arm/mach-imx/clock-imx6q.c deleted file mode 100644 index 111c328f5420..000000000000 --- a/arch/arm/mach-imx/clock-imx6q.c +++ /dev/null | |||
@@ -1,2111 +0,0 @@ | |||
1 | /* | ||
2 | * Copyright 2011 Freescale Semiconductor, Inc. | ||
3 | * Copyright 2011 Linaro Ltd. | ||
4 | * | ||
5 | * The code contained herein is licensed under the GNU General Public | ||
6 | * License. You may obtain a copy of the GNU General Public License | ||
7 | * Version 2 or later at the following locations: | ||
8 | * | ||
9 | * http://www.opensource.org/licenses/gpl-license.html | ||
10 | * http://www.gnu.org/copyleft/gpl.html | ||
11 | */ | ||
12 | |||
13 | #include <linux/init.h> | ||
14 | #include <linux/types.h> | ||
15 | #include <linux/clk.h> | ||
16 | #include <linux/clkdev.h> | ||
17 | #include <linux/io.h> | ||
18 | #include <linux/of.h> | ||
19 | #include <linux/of_address.h> | ||
20 | #include <linux/of_irq.h> | ||
21 | #include <asm/div64.h> | ||
22 | #include <asm/mach/map.h> | ||
23 | #include <mach/clock.h> | ||
24 | #include <mach/common.h> | ||
25 | #include <mach/hardware.h> | ||
26 | |||
27 | #define PLL_BASE IMX_IO_ADDRESS(MX6Q_ANATOP_BASE_ADDR) | ||
28 | #define PLL1_SYS (PLL_BASE + 0x000) | ||
29 | #define PLL2_BUS (PLL_BASE + 0x030) | ||
30 | #define PLL3_USB_OTG (PLL_BASE + 0x010) | ||
31 | #define PLL4_AUDIO (PLL_BASE + 0x070) | ||
32 | #define PLL5_VIDEO (PLL_BASE + 0x0a0) | ||
33 | #define PLL6_MLB (PLL_BASE + 0x0d0) | ||
34 | #define PLL7_USB_HOST (PLL_BASE + 0x020) | ||
35 | #define PLL8_ENET (PLL_BASE + 0x0e0) | ||
36 | #define PFD_480 (PLL_BASE + 0x0f0) | ||
37 | #define PFD_528 (PLL_BASE + 0x100) | ||
38 | #define PLL_NUM_OFFSET 0x010 | ||
39 | #define PLL_DENOM_OFFSET 0x020 | ||
40 | |||
41 | #define PFD0 7 | ||
42 | #define PFD1 15 | ||
43 | #define PFD2 23 | ||
44 | #define PFD3 31 | ||
45 | #define PFD_FRAC_MASK 0x3f | ||
46 | |||
47 | #define BM_PLL_BYPASS (0x1 << 16) | ||
48 | #define BM_PLL_ENABLE (0x1 << 13) | ||
49 | #define BM_PLL_POWER_DOWN (0x1 << 12) | ||
50 | #define BM_PLL_LOCK (0x1 << 31) | ||
51 | #define BP_PLL_SYS_DIV_SELECT 0 | ||
52 | #define BM_PLL_SYS_DIV_SELECT (0x7f << 0) | ||
53 | #define BP_PLL_BUS_DIV_SELECT 0 | ||
54 | #define BM_PLL_BUS_DIV_SELECT (0x1 << 0) | ||
55 | #define BP_PLL_USB_DIV_SELECT 0 | ||
56 | #define BM_PLL_USB_DIV_SELECT (0x3 << 0) | ||
57 | #define BP_PLL_AV_DIV_SELECT 0 | ||
58 | #define BM_PLL_AV_DIV_SELECT (0x7f << 0) | ||
59 | #define BP_PLL_ENET_DIV_SELECT 0 | ||
60 | #define BM_PLL_ENET_DIV_SELECT (0x3 << 0) | ||
61 | #define BM_PLL_ENET_EN_PCIE (0x1 << 19) | ||
62 | #define BM_PLL_ENET_EN_SATA (0x1 << 20) | ||
63 | |||
64 | #define CCM_BASE IMX_IO_ADDRESS(MX6Q_CCM_BASE_ADDR) | ||
65 | #define CCR (CCM_BASE + 0x00) | ||
66 | #define CCDR (CCM_BASE + 0x04) | ||
67 | #define CSR (CCM_BASE + 0x08) | ||
68 | #define CCSR (CCM_BASE + 0x0c) | ||
69 | #define CACRR (CCM_BASE + 0x10) | ||
70 | #define CBCDR (CCM_BASE + 0x14) | ||
71 | #define CBCMR (CCM_BASE + 0x18) | ||
72 | #define CSCMR1 (CCM_BASE + 0x1c) | ||
73 | #define CSCMR2 (CCM_BASE + 0x20) | ||
74 | #define CSCDR1 (CCM_BASE + 0x24) | ||
75 | #define CS1CDR (CCM_BASE + 0x28) | ||
76 | #define CS2CDR (CCM_BASE + 0x2c) | ||
77 | #define CDCDR (CCM_BASE + 0x30) | ||
78 | #define CHSCCDR (CCM_BASE + 0x34) | ||
79 | #define CSCDR2 (CCM_BASE + 0x38) | ||
80 | #define CSCDR3 (CCM_BASE + 0x3c) | ||
81 | #define CSCDR4 (CCM_BASE + 0x40) | ||
82 | #define CWDR (CCM_BASE + 0x44) | ||
83 | #define CDHIPR (CCM_BASE + 0x48) | ||
84 | #define CDCR (CCM_BASE + 0x4c) | ||
85 | #define CTOR (CCM_BASE + 0x50) | ||
86 | #define CLPCR (CCM_BASE + 0x54) | ||
87 | #define CISR (CCM_BASE + 0x58) | ||
88 | #define CIMR (CCM_BASE + 0x5c) | ||
89 | #define CCOSR (CCM_BASE + 0x60) | ||
90 | #define CGPR (CCM_BASE + 0x64) | ||
91 | #define CCGR0 (CCM_BASE + 0x68) | ||
92 | #define CCGR1 (CCM_BASE + 0x6c) | ||
93 | #define CCGR2 (CCM_BASE + 0x70) | ||
94 | #define CCGR3 (CCM_BASE + 0x74) | ||
95 | #define CCGR4 (CCM_BASE + 0x78) | ||
96 | #define CCGR5 (CCM_BASE + 0x7c) | ||
97 | #define CCGR6 (CCM_BASE + 0x80) | ||
98 | #define CCGR7 (CCM_BASE + 0x84) | ||
99 | #define CMEOR (CCM_BASE + 0x88) | ||
100 | |||
101 | #define CG0 0 | ||
102 | #define CG1 2 | ||
103 | #define CG2 4 | ||
104 | #define CG3 6 | ||
105 | #define CG4 8 | ||
106 | #define CG5 10 | ||
107 | #define CG6 12 | ||
108 | #define CG7 14 | ||
109 | #define CG8 16 | ||
110 | #define CG9 18 | ||
111 | #define CG10 20 | ||
112 | #define CG11 22 | ||
113 | #define CG12 24 | ||
114 | #define CG13 26 | ||
115 | #define CG14 28 | ||
116 | #define CG15 30 | ||
117 | |||
118 | #define BM_CCSR_PLL1_SW_SEL (0x1 << 2) | ||
119 | #define BM_CCSR_STEP_SEL (0x1 << 8) | ||
120 | |||
121 | #define BP_CACRR_ARM_PODF 0 | ||
122 | #define BM_CACRR_ARM_PODF (0x7 << 0) | ||
123 | |||
124 | #define BP_CBCDR_PERIPH2_CLK2_PODF 0 | ||
125 | #define BM_CBCDR_PERIPH2_CLK2_PODF (0x7 << 0) | ||
126 | #define BP_CBCDR_MMDC_CH1_AXI_PODF 3 | ||
127 | #define BM_CBCDR_MMDC_CH1_AXI_PODF (0x7 << 3) | ||
128 | #define BP_CBCDR_AXI_SEL 6 | ||
129 | #define BM_CBCDR_AXI_SEL (0x3 << 6) | ||
130 | #define BP_CBCDR_IPG_PODF 8 | ||
131 | #define BM_CBCDR_IPG_PODF (0x3 << 8) | ||
132 | #define BP_CBCDR_AHB_PODF 10 | ||
133 | #define BM_CBCDR_AHB_PODF (0x7 << 10) | ||
134 | #define BP_CBCDR_AXI_PODF 16 | ||
135 | #define BM_CBCDR_AXI_PODF (0x7 << 16) | ||
136 | #define BP_CBCDR_MMDC_CH0_AXI_PODF 19 | ||
137 | #define BM_CBCDR_MMDC_CH0_AXI_PODF (0x7 << 19) | ||
138 | #define BP_CBCDR_PERIPH_CLK_SEL 25 | ||
139 | #define BM_CBCDR_PERIPH_CLK_SEL (0x1 << 25) | ||
140 | #define BP_CBCDR_PERIPH2_CLK_SEL 26 | ||
141 | #define BM_CBCDR_PERIPH2_CLK_SEL (0x1 << 26) | ||
142 | #define BP_CBCDR_PERIPH_CLK2_PODF 27 | ||
143 | #define BM_CBCDR_PERIPH_CLK2_PODF (0x7 << 27) | ||
144 | |||
145 | #define BP_CBCMR_GPU2D_AXI_SEL 0 | ||
146 | #define BM_CBCMR_GPU2D_AXI_SEL (0x1 << 0) | ||
147 | #define BP_CBCMR_GPU3D_AXI_SEL 1 | ||
148 | #define BM_CBCMR_GPU3D_AXI_SEL (0x1 << 1) | ||
149 | #define BP_CBCMR_GPU3D_CORE_SEL 4 | ||
150 | #define BM_CBCMR_GPU3D_CORE_SEL (0x3 << 4) | ||
151 | #define BP_CBCMR_GPU3D_SHADER_SEL 8 | ||
152 | #define BM_CBCMR_GPU3D_SHADER_SEL (0x3 << 8) | ||
153 | #define BP_CBCMR_PCIE_AXI_SEL 10 | ||
154 | #define BM_CBCMR_PCIE_AXI_SEL (0x1 << 10) | ||
155 | #define BP_CBCMR_VDO_AXI_SEL 11 | ||
156 | #define BM_CBCMR_VDO_AXI_SEL (0x1 << 11) | ||
157 | #define BP_CBCMR_PERIPH_CLK2_SEL 12 | ||
158 | #define BM_CBCMR_PERIPH_CLK2_SEL (0x3 << 12) | ||
159 | #define BP_CBCMR_VPU_AXI_SEL 14 | ||
160 | #define BM_CBCMR_VPU_AXI_SEL (0x3 << 14) | ||
161 | #define BP_CBCMR_GPU2D_CORE_SEL 16 | ||
162 | #define BM_CBCMR_GPU2D_CORE_SEL (0x3 << 16) | ||
163 | #define BP_CBCMR_PRE_PERIPH_CLK_SEL 18 | ||
164 | #define BM_CBCMR_PRE_PERIPH_CLK_SEL (0x3 << 18) | ||
165 | #define BP_CBCMR_PERIPH2_CLK2_SEL 20 | ||
166 | #define BM_CBCMR_PERIPH2_CLK2_SEL (0x1 << 20) | ||
167 | #define BP_CBCMR_PRE_PERIPH2_CLK_SEL 21 | ||
168 | #define BM_CBCMR_PRE_PERIPH2_CLK_SEL (0x3 << 21) | ||
169 | #define BP_CBCMR_GPU2D_CORE_PODF 23 | ||
170 | #define BM_CBCMR_GPU2D_CORE_PODF (0x7 << 23) | ||
171 | #define BP_CBCMR_GPU3D_CORE_PODF 26 | ||
172 | #define BM_CBCMR_GPU3D_CORE_PODF (0x7 << 26) | ||
173 | #define BP_CBCMR_GPU3D_SHADER_PODF 29 | ||
174 | #define BM_CBCMR_GPU3D_SHADER_PODF (0x7 << 29) | ||
175 | |||
176 | #define BP_CSCMR1_PERCLK_PODF 0 | ||
177 | #define BM_CSCMR1_PERCLK_PODF (0x3f << 0) | ||
178 | #define BP_CSCMR1_SSI1_SEL 10 | ||
179 | #define BM_CSCMR1_SSI1_SEL (0x3 << 10) | ||
180 | #define BP_CSCMR1_SSI2_SEL 12 | ||
181 | #define BM_CSCMR1_SSI2_SEL (0x3 << 12) | ||
182 | #define BP_CSCMR1_SSI3_SEL 14 | ||
183 | #define BM_CSCMR1_SSI3_SEL (0x3 << 14) | ||
184 | #define BP_CSCMR1_USDHC1_SEL 16 | ||
185 | #define BM_CSCMR1_USDHC1_SEL (0x1 << 16) | ||
186 | #define BP_CSCMR1_USDHC2_SEL 17 | ||
187 | #define BM_CSCMR1_USDHC2_SEL (0x1 << 17) | ||
188 | #define BP_CSCMR1_USDHC3_SEL 18 | ||
189 | #define BM_CSCMR1_USDHC3_SEL (0x1 << 18) | ||
190 | #define BP_CSCMR1_USDHC4_SEL 19 | ||
191 | #define BM_CSCMR1_USDHC4_SEL (0x1 << 19) | ||
192 | #define BP_CSCMR1_EMI_PODF 20 | ||
193 | #define BM_CSCMR1_EMI_PODF (0x7 << 20) | ||
194 | #define BP_CSCMR1_EMI_SLOW_PODF 23 | ||
195 | #define BM_CSCMR1_EMI_SLOW_PODF (0x7 << 23) | ||
196 | #define BP_CSCMR1_EMI_SEL 27 | ||
197 | #define BM_CSCMR1_EMI_SEL (0x3 << 27) | ||
198 | #define BP_CSCMR1_EMI_SLOW_SEL 29 | ||
199 | #define BM_CSCMR1_EMI_SLOW_SEL (0x3 << 29) | ||
200 | |||
201 | #define BP_CSCMR2_CAN_PODF 2 | ||
202 | #define BM_CSCMR2_CAN_PODF (0x3f << 2) | ||
203 | #define BM_CSCMR2_LDB_DI0_IPU_DIV (0x1 << 10) | ||
204 | #define BM_CSCMR2_LDB_DI1_IPU_DIV (0x1 << 11) | ||
205 | #define BP_CSCMR2_ESAI_SEL 19 | ||
206 | #define BM_CSCMR2_ESAI_SEL (0x3 << 19) | ||
207 | |||
208 | #define BP_CSCDR1_UART_PODF 0 | ||
209 | #define BM_CSCDR1_UART_PODF (0x3f << 0) | ||
210 | #define BP_CSCDR1_USDHC1_PODF 11 | ||
211 | #define BM_CSCDR1_USDHC1_PODF (0x7 << 11) | ||
212 | #define BP_CSCDR1_USDHC2_PODF 16 | ||
213 | #define BM_CSCDR1_USDHC2_PODF (0x7 << 16) | ||
214 | #define BP_CSCDR1_USDHC3_PODF 19 | ||
215 | #define BM_CSCDR1_USDHC3_PODF (0x7 << 19) | ||
216 | #define BP_CSCDR1_USDHC4_PODF 22 | ||
217 | #define BM_CSCDR1_USDHC4_PODF (0x7 << 22) | ||
218 | #define BP_CSCDR1_VPU_AXI_PODF 25 | ||
219 | #define BM_CSCDR1_VPU_AXI_PODF (0x7 << 25) | ||
220 | |||
221 | #define BP_CS1CDR_SSI1_PODF 0 | ||
222 | #define BM_CS1CDR_SSI1_PODF (0x3f << 0) | ||
223 | #define BP_CS1CDR_SSI1_PRED 6 | ||
224 | #define BM_CS1CDR_SSI1_PRED (0x7 << 6) | ||
225 | #define BP_CS1CDR_ESAI_PRED 9 | ||
226 | #define BM_CS1CDR_ESAI_PRED (0x7 << 9) | ||
227 | #define BP_CS1CDR_SSI3_PODF 16 | ||
228 | #define BM_CS1CDR_SSI3_PODF (0x3f << 16) | ||
229 | #define BP_CS1CDR_SSI3_PRED 22 | ||
230 | #define BM_CS1CDR_SSI3_PRED (0x7 << 22) | ||
231 | #define BP_CS1CDR_ESAI_PODF 25 | ||
232 | #define BM_CS1CDR_ESAI_PODF (0x7 << 25) | ||
233 | |||
234 | #define BP_CS2CDR_SSI2_PODF 0 | ||
235 | #define BM_CS2CDR_SSI2_PODF (0x3f << 0) | ||
236 | #define BP_CS2CDR_SSI2_PRED 6 | ||
237 | #define BM_CS2CDR_SSI2_PRED (0x7 << 6) | ||
238 | #define BP_CS2CDR_LDB_DI0_SEL 9 | ||
239 | #define BM_CS2CDR_LDB_DI0_SEL (0x7 << 9) | ||
240 | #define BP_CS2CDR_LDB_DI1_SEL 12 | ||
241 | #define BM_CS2CDR_LDB_DI1_SEL (0x7 << 12) | ||
242 | #define BP_CS2CDR_ENFC_SEL 16 | ||
243 | #define BM_CS2CDR_ENFC_SEL (0x3 << 16) | ||
244 | #define BP_CS2CDR_ENFC_PRED 18 | ||
245 | #define BM_CS2CDR_ENFC_PRED (0x7 << 18) | ||
246 | #define BP_CS2CDR_ENFC_PODF 21 | ||
247 | #define BM_CS2CDR_ENFC_PODF (0x3f << 21) | ||
248 | |||
249 | #define BP_CDCDR_ASRC_SERIAL_SEL 7 | ||
250 | #define BM_CDCDR_ASRC_SERIAL_SEL (0x3 << 7) | ||
251 | #define BP_CDCDR_ASRC_SERIAL_PODF 9 | ||
252 | #define BM_CDCDR_ASRC_SERIAL_PODF (0x7 << 9) | ||
253 | #define BP_CDCDR_ASRC_SERIAL_PRED 12 | ||
254 | #define BM_CDCDR_ASRC_SERIAL_PRED (0x7 << 12) | ||
255 | #define BP_CDCDR_SPDIF_SEL 20 | ||
256 | #define BM_CDCDR_SPDIF_SEL (0x3 << 20) | ||
257 | #define BP_CDCDR_SPDIF_PODF 22 | ||
258 | #define BM_CDCDR_SPDIF_PODF (0x7 << 22) | ||
259 | #define BP_CDCDR_SPDIF_PRED 25 | ||
260 | #define BM_CDCDR_SPDIF_PRED (0x7 << 25) | ||
261 | #define BP_CDCDR_HSI_TX_PODF 29 | ||
262 | #define BM_CDCDR_HSI_TX_PODF (0x7 << 29) | ||
263 | #define BP_CDCDR_HSI_TX_SEL 28 | ||
264 | #define BM_CDCDR_HSI_TX_SEL (0x1 << 28) | ||
265 | |||
266 | #define BP_CHSCCDR_IPU1_DI0_SEL 0 | ||
267 | #define BM_CHSCCDR_IPU1_DI0_SEL (0x7 << 0) | ||
268 | #define BP_CHSCCDR_IPU1_DI0_PRE_PODF 3 | ||
269 | #define BM_CHSCCDR_IPU1_DI0_PRE_PODF (0x7 << 3) | ||
270 | #define BP_CHSCCDR_IPU1_DI0_PRE_SEL 6 | ||
271 | #define BM_CHSCCDR_IPU1_DI0_PRE_SEL (0x7 << 6) | ||
272 | #define BP_CHSCCDR_IPU1_DI1_SEL 9 | ||
273 | #define BM_CHSCCDR_IPU1_DI1_SEL (0x7 << 9) | ||
274 | #define BP_CHSCCDR_IPU1_DI1_PRE_PODF 12 | ||
275 | #define BM_CHSCCDR_IPU1_DI1_PRE_PODF (0x7 << 12) | ||
276 | #define BP_CHSCCDR_IPU1_DI1_PRE_SEL 15 | ||
277 | #define BM_CHSCCDR_IPU1_DI1_PRE_SEL (0x7 << 15) | ||
278 | |||
279 | #define BP_CSCDR2_IPU2_DI0_SEL 0 | ||
280 | #define BM_CSCDR2_IPU2_DI0_SEL (0x7) | ||
281 | #define BP_CSCDR2_IPU2_DI0_PRE_PODF 3 | ||
282 | #define BM_CSCDR2_IPU2_DI0_PRE_PODF (0x7 << 3) | ||
283 | #define BP_CSCDR2_IPU2_DI0_PRE_SEL 6 | ||
284 | #define BM_CSCDR2_IPU2_DI0_PRE_SEL (0x7 << 6) | ||
285 | #define BP_CSCDR2_IPU2_DI1_SEL 9 | ||
286 | #define BM_CSCDR2_IPU2_DI1_SEL (0x7 << 9) | ||
287 | #define BP_CSCDR2_IPU2_DI1_PRE_PODF 12 | ||
288 | #define BM_CSCDR2_IPU2_DI1_PRE_PODF (0x7 << 12) | ||
289 | #define BP_CSCDR2_IPU2_DI1_PRE_SEL 15 | ||
290 | #define BM_CSCDR2_IPU2_DI1_PRE_SEL (0x7 << 15) | ||
291 | #define BP_CSCDR2_ECSPI_CLK_PODF 19 | ||
292 | #define BM_CSCDR2_ECSPI_CLK_PODF (0x3f << 19) | ||
293 | |||
294 | #define BP_CSCDR3_IPU1_HSP_SEL 9 | ||
295 | #define BM_CSCDR3_IPU1_HSP_SEL (0x3 << 9) | ||
296 | #define BP_CSCDR3_IPU1_HSP_PODF 11 | ||
297 | #define BM_CSCDR3_IPU1_HSP_PODF (0x7 << 11) | ||
298 | #define BP_CSCDR3_IPU2_HSP_SEL 14 | ||
299 | #define BM_CSCDR3_IPU2_HSP_SEL (0x3 << 14) | ||
300 | #define BP_CSCDR3_IPU2_HSP_PODF 16 | ||
301 | #define BM_CSCDR3_IPU2_HSP_PODF (0x7 << 16) | ||
302 | |||
303 | #define BM_CDHIPR_AXI_PODF_BUSY (0x1 << 0) | ||
304 | #define BM_CDHIPR_AHB_PODF_BUSY (0x1 << 1) | ||
305 | #define BM_CDHIPR_MMDC_CH1_PODF_BUSY (0x1 << 2) | ||
306 | #define BM_CDHIPR_PERIPH2_SEL_BUSY (0x1 << 3) | ||
307 | #define BM_CDHIPR_MMDC_CH0_PODF_BUSY (0x1 << 4) | ||
308 | #define BM_CDHIPR_PERIPH_SEL_BUSY (0x1 << 5) | ||
309 | #define BM_CDHIPR_ARM_PODF_BUSY (0x1 << 16) | ||
310 | |||
311 | #define BP_CLPCR_LPM 0 | ||
312 | #define BM_CLPCR_LPM (0x3 << 0) | ||
313 | #define BM_CLPCR_BYPASS_PMIC_READY (0x1 << 2) | ||
314 | #define BM_CLPCR_ARM_CLK_DIS_ON_LPM (0x1 << 5) | ||
315 | #define BM_CLPCR_SBYOS (0x1 << 6) | ||
316 | #define BM_CLPCR_DIS_REF_OSC (0x1 << 7) | ||
317 | #define BM_CLPCR_VSTBY (0x1 << 8) | ||
318 | #define BP_CLPCR_STBY_COUNT 9 | ||
319 | #define BM_CLPCR_STBY_COUNT (0x3 << 9) | ||
320 | #define BM_CLPCR_COSC_PWRDOWN (0x1 << 11) | ||
321 | #define BM_CLPCR_WB_PER_AT_LPM (0x1 << 16) | ||
322 | #define BM_CLPCR_WB_CORE_AT_LPM (0x1 << 17) | ||
323 | #define BM_CLPCR_BYP_MMDC_CH0_LPM_HS (0x1 << 19) | ||
324 | #define BM_CLPCR_BYP_MMDC_CH1_LPM_HS (0x1 << 21) | ||
325 | #define BM_CLPCR_MASK_CORE0_WFI (0x1 << 22) | ||
326 | #define BM_CLPCR_MASK_CORE1_WFI (0x1 << 23) | ||
327 | #define BM_CLPCR_MASK_CORE2_WFI (0x1 << 24) | ||
328 | #define BM_CLPCR_MASK_CORE3_WFI (0x1 << 25) | ||
329 | #define BM_CLPCR_MASK_SCU_IDLE (0x1 << 26) | ||
330 | #define BM_CLPCR_MASK_L2CC_IDLE (0x1 << 27) | ||
331 | |||
332 | #define BP_CCOSR_CKO1_EN 7 | ||
333 | #define BP_CCOSR_CKO1_PODF 4 | ||
334 | #define BM_CCOSR_CKO1_PODF (0x7 << 4) | ||
335 | #define BP_CCOSR_CKO1_SEL 0 | ||
336 | #define BM_CCOSR_CKO1_SEL (0xf << 0) | ||
337 | |||
338 | #define FREQ_480M 480000000 | ||
339 | #define FREQ_528M 528000000 | ||
340 | #define FREQ_594M 594000000 | ||
341 | #define FREQ_650M 650000000 | ||
342 | #define FREQ_1300M 1300000000 | ||
343 | |||
344 | static struct clk pll1_sys; | ||
345 | static struct clk pll2_bus; | ||
346 | static struct clk pll3_usb_otg; | ||
347 | static struct clk pll4_audio; | ||
348 | static struct clk pll5_video; | ||
349 | static struct clk pll6_mlb; | ||
350 | static struct clk pll7_usb_host; | ||
351 | static struct clk pll8_enet; | ||
352 | static struct clk apbh_dma_clk; | ||
353 | static struct clk arm_clk; | ||
354 | static struct clk ipg_clk; | ||
355 | static struct clk ahb_clk; | ||
356 | static struct clk axi_clk; | ||
357 | static struct clk mmdc_ch0_axi_clk; | ||
358 | static struct clk mmdc_ch1_axi_clk; | ||
359 | static struct clk periph_clk; | ||
360 | static struct clk periph_pre_clk; | ||
361 | static struct clk periph_clk2_clk; | ||
362 | static struct clk periph2_clk; | ||
363 | static struct clk periph2_pre_clk; | ||
364 | static struct clk periph2_clk2_clk; | ||
365 | static struct clk gpu2d_core_clk; | ||
366 | static struct clk gpu3d_core_clk; | ||
367 | static struct clk gpu3d_shader_clk; | ||
368 | static struct clk ipg_perclk; | ||
369 | static struct clk emi_clk; | ||
370 | static struct clk emi_slow_clk; | ||
371 | static struct clk can1_clk; | ||
372 | static struct clk uart_clk; | ||
373 | static struct clk usdhc1_clk; | ||
374 | static struct clk usdhc2_clk; | ||
375 | static struct clk usdhc3_clk; | ||
376 | static struct clk usdhc4_clk; | ||
377 | static struct clk vpu_clk; | ||
378 | static struct clk hsi_tx_clk; | ||
379 | static struct clk ipu1_di0_pre_clk; | ||
380 | static struct clk ipu1_di1_pre_clk; | ||
381 | static struct clk ipu2_di0_pre_clk; | ||
382 | static struct clk ipu2_di1_pre_clk; | ||
383 | static struct clk ipu1_clk; | ||
384 | static struct clk ipu2_clk; | ||
385 | static struct clk ssi1_clk; | ||
386 | static struct clk ssi3_clk; | ||
387 | static struct clk esai_clk; | ||
388 | static struct clk ssi2_clk; | ||
389 | static struct clk spdif_clk; | ||
390 | static struct clk asrc_serial_clk; | ||
391 | static struct clk gpu2d_axi_clk; | ||
392 | static struct clk gpu3d_axi_clk; | ||
393 | static struct clk pcie_clk; | ||
394 | static struct clk vdo_axi_clk; | ||
395 | static struct clk ldb_di0_clk; | ||
396 | static struct clk ldb_di1_clk; | ||
397 | static struct clk ipu1_di0_clk; | ||
398 | static struct clk ipu1_di1_clk; | ||
399 | static struct clk ipu2_di0_clk; | ||
400 | static struct clk ipu2_di1_clk; | ||
401 | static struct clk enfc_clk; | ||
402 | static struct clk cko1_clk; | ||
403 | static struct clk dummy_clk = {}; | ||
404 | |||
405 | static unsigned long external_high_reference; | ||
406 | static unsigned long external_low_reference; | ||
407 | static unsigned long oscillator_reference; | ||
408 | |||
409 | static unsigned long get_oscillator_reference_clock_rate(struct clk *clk) | ||
410 | { | ||
411 | return oscillator_reference; | ||
412 | } | ||
413 | |||
414 | static unsigned long get_high_reference_clock_rate(struct clk *clk) | ||
415 | { | ||
416 | return external_high_reference; | ||
417 | } | ||
418 | |||
419 | static unsigned long get_low_reference_clock_rate(struct clk *clk) | ||
420 | { | ||
421 | return external_low_reference; | ||
422 | } | ||
423 | |||
424 | static struct clk ckil_clk = { | ||
425 | .get_rate = get_low_reference_clock_rate, | ||
426 | }; | ||
427 | |||
428 | static struct clk ckih_clk = { | ||
429 | .get_rate = get_high_reference_clock_rate, | ||
430 | }; | ||
431 | |||
432 | static struct clk osc_clk = { | ||
433 | .get_rate = get_oscillator_reference_clock_rate, | ||
434 | }; | ||
435 | |||
436 | static inline void __iomem *pll_get_reg_addr(struct clk *pll) | ||
437 | { | ||
438 | if (pll == &pll1_sys) | ||
439 | return PLL1_SYS; | ||
440 | else if (pll == &pll2_bus) | ||
441 | return PLL2_BUS; | ||
442 | else if (pll == &pll3_usb_otg) | ||
443 | return PLL3_USB_OTG; | ||
444 | else if (pll == &pll4_audio) | ||
445 | return PLL4_AUDIO; | ||
446 | else if (pll == &pll5_video) | ||
447 | return PLL5_VIDEO; | ||
448 | else if (pll == &pll6_mlb) | ||
449 | return PLL6_MLB; | ||
450 | else if (pll == &pll7_usb_host) | ||
451 | return PLL7_USB_HOST; | ||
452 | else if (pll == &pll8_enet) | ||
453 | return PLL8_ENET; | ||
454 | else | ||
455 | BUG(); | ||
456 | |||
457 | return NULL; | ||
458 | } | ||
459 | |||
460 | static int pll_enable(struct clk *clk) | ||
461 | { | ||
462 | int timeout = 0x100000; | ||
463 | void __iomem *reg; | ||
464 | u32 val; | ||
465 | |||
466 | reg = pll_get_reg_addr(clk); | ||
467 | val = readl_relaxed(reg); | ||
468 | val &= ~BM_PLL_BYPASS; | ||
469 | val &= ~BM_PLL_POWER_DOWN; | ||
470 | /* 480MHz PLLs have the opposite definition for power bit */ | ||
471 | if (clk == &pll3_usb_otg || clk == &pll7_usb_host) | ||
472 | val |= BM_PLL_POWER_DOWN; | ||
473 | writel_relaxed(val, reg); | ||
474 | |||
475 | /* Wait for PLL to lock */ | ||
476 | while (!(readl_relaxed(reg) & BM_PLL_LOCK) && --timeout) | ||
477 | cpu_relax(); | ||
478 | |||
479 | if (unlikely(!timeout)) | ||
480 | return -EBUSY; | ||
481 | |||
482 | /* Enable the PLL output now */ | ||
483 | val = readl_relaxed(reg); | ||
484 | val |= BM_PLL_ENABLE; | ||
485 | writel_relaxed(val, reg); | ||
486 | |||
487 | return 0; | ||
488 | } | ||
489 | |||
490 | static void pll_disable(struct clk *clk) | ||
491 | { | ||
492 | void __iomem *reg; | ||
493 | u32 val; | ||
494 | |||
495 | reg = pll_get_reg_addr(clk); | ||
496 | val = readl_relaxed(reg); | ||
497 | val &= ~BM_PLL_ENABLE; | ||
498 | val |= BM_PLL_BYPASS; | ||
499 | val |= BM_PLL_POWER_DOWN; | ||
500 | if (clk == &pll3_usb_otg || clk == &pll7_usb_host) | ||
501 | val &= ~BM_PLL_POWER_DOWN; | ||
502 | writel_relaxed(val, reg); | ||
503 | } | ||
504 | |||
505 | static unsigned long pll1_sys_get_rate(struct clk *clk) | ||
506 | { | ||
507 | u32 div = (readl_relaxed(PLL1_SYS) & BM_PLL_SYS_DIV_SELECT) >> | ||
508 | BP_PLL_SYS_DIV_SELECT; | ||
509 | |||
510 | return clk_get_rate(clk->parent) * div / 2; | ||
511 | } | ||
512 | |||
513 | static int pll1_sys_set_rate(struct clk *clk, unsigned long rate) | ||
514 | { | ||
515 | u32 val, div; | ||
516 | |||
517 | if (rate < FREQ_650M || rate > FREQ_1300M) | ||
518 | return -EINVAL; | ||
519 | |||
520 | div = rate * 2 / clk_get_rate(clk->parent); | ||
521 | val = readl_relaxed(PLL1_SYS); | ||
522 | val &= ~BM_PLL_SYS_DIV_SELECT; | ||
523 | val |= div << BP_PLL_SYS_DIV_SELECT; | ||
524 | writel_relaxed(val, PLL1_SYS); | ||
525 | |||
526 | return 0; | ||
527 | } | ||
528 | |||
529 | static unsigned long pll8_enet_get_rate(struct clk *clk) | ||
530 | { | ||
531 | u32 div = (readl_relaxed(PLL8_ENET) & BM_PLL_ENET_DIV_SELECT) >> | ||
532 | BP_PLL_ENET_DIV_SELECT; | ||
533 | |||
534 | switch (div) { | ||
535 | case 0: | ||
536 | return 25000000; | ||
537 | case 1: | ||
538 | return 50000000; | ||
539 | case 2: | ||
540 | return 100000000; | ||
541 | case 3: | ||
542 | return 125000000; | ||
543 | } | ||
544 | |||
545 | return 0; | ||
546 | } | ||
547 | |||
548 | static int pll8_enet_set_rate(struct clk *clk, unsigned long rate) | ||
549 | { | ||
550 | u32 val, div; | ||
551 | |||
552 | switch (rate) { | ||
553 | case 25000000: | ||
554 | div = 0; | ||
555 | break; | ||
556 | case 50000000: | ||
557 | div = 1; | ||
558 | break; | ||
559 | case 100000000: | ||
560 | div = 2; | ||
561 | break; | ||
562 | case 125000000: | ||
563 | div = 3; | ||
564 | break; | ||
565 | default: | ||
566 | return -EINVAL; | ||
567 | } | ||
568 | |||
569 | val = readl_relaxed(PLL8_ENET); | ||
570 | val &= ~BM_PLL_ENET_DIV_SELECT; | ||
571 | val |= div << BP_PLL_ENET_DIV_SELECT; | ||
572 | writel_relaxed(val, PLL8_ENET); | ||
573 | |||
574 | return 0; | ||
575 | } | ||
576 | |||
577 | static unsigned long pll_av_get_rate(struct clk *clk) | ||
578 | { | ||
579 | void __iomem *reg = (clk == &pll4_audio) ? PLL4_AUDIO : PLL5_VIDEO; | ||
580 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
581 | u32 mfn = readl_relaxed(reg + PLL_NUM_OFFSET); | ||
582 | u32 mfd = readl_relaxed(reg + PLL_DENOM_OFFSET); | ||
583 | u32 div = (readl_relaxed(reg) & BM_PLL_AV_DIV_SELECT) >> | ||
584 | BP_PLL_AV_DIV_SELECT; | ||
585 | |||
586 | return (parent_rate * div) + ((parent_rate / mfd) * mfn); | ||
587 | } | ||
588 | |||
589 | static int pll_av_set_rate(struct clk *clk, unsigned long rate) | ||
590 | { | ||
591 | void __iomem *reg = (clk == &pll4_audio) ? PLL4_AUDIO : PLL5_VIDEO; | ||
592 | unsigned int parent_rate = clk_get_rate(clk->parent); | ||
593 | u32 val, div; | ||
594 | u32 mfn, mfd = 1000000; | ||
595 | s64 temp64; | ||
596 | |||
597 | if (rate < FREQ_650M || rate > FREQ_1300M) | ||
598 | return -EINVAL; | ||
599 | |||
600 | div = rate / parent_rate; | ||
601 | temp64 = (u64) (rate - div * parent_rate); | ||
602 | temp64 *= mfd; | ||
603 | do_div(temp64, parent_rate); | ||
604 | mfn = temp64; | ||
605 | |||
606 | val = readl_relaxed(reg); | ||
607 | val &= ~BM_PLL_AV_DIV_SELECT; | ||
608 | val |= div << BP_PLL_AV_DIV_SELECT; | ||
609 | writel_relaxed(val, reg); | ||
610 | writel_relaxed(mfn, reg + PLL_NUM_OFFSET); | ||
611 | writel_relaxed(mfd, reg + PLL_DENOM_OFFSET); | ||
612 | |||
613 | return 0; | ||
614 | } | ||
615 | |||
616 | static void __iomem *pll_get_div_reg_bit(struct clk *clk, u32 *bp, u32 *bm) | ||
617 | { | ||
618 | void __iomem *reg; | ||
619 | |||
620 | if (clk == &pll2_bus) { | ||
621 | reg = PLL2_BUS; | ||
622 | *bp = BP_PLL_BUS_DIV_SELECT; | ||
623 | *bm = BM_PLL_BUS_DIV_SELECT; | ||
624 | } else if (clk == &pll3_usb_otg) { | ||
625 | reg = PLL3_USB_OTG; | ||
626 | *bp = BP_PLL_USB_DIV_SELECT; | ||
627 | *bm = BM_PLL_USB_DIV_SELECT; | ||
628 | } else if (clk == &pll7_usb_host) { | ||
629 | reg = PLL7_USB_HOST; | ||
630 | *bp = BP_PLL_USB_DIV_SELECT; | ||
631 | *bm = BM_PLL_USB_DIV_SELECT; | ||
632 | } else { | ||
633 | BUG(); | ||
634 | } | ||
635 | |||
636 | return reg; | ||
637 | } | ||
638 | |||
639 | static unsigned long pll_get_rate(struct clk *clk) | ||
640 | { | ||
641 | void __iomem *reg; | ||
642 | u32 div, bp, bm; | ||
643 | |||
644 | reg = pll_get_div_reg_bit(clk, &bp, &bm); | ||
645 | div = (readl_relaxed(reg) & bm) >> bp; | ||
646 | |||
647 | return (div == 1) ? clk_get_rate(clk->parent) * 22 : | ||
648 | clk_get_rate(clk->parent) * 20; | ||
649 | } | ||
650 | |||
651 | static int pll_set_rate(struct clk *clk, unsigned long rate) | ||
652 | { | ||
653 | void __iomem *reg; | ||
654 | u32 val, div, bp, bm; | ||
655 | |||
656 | if (rate == FREQ_528M) | ||
657 | div = 1; | ||
658 | else if (rate == FREQ_480M) | ||
659 | div = 0; | ||
660 | else | ||
661 | return -EINVAL; | ||
662 | |||
663 | reg = pll_get_div_reg_bit(clk, &bp, &bm); | ||
664 | val = readl_relaxed(reg); | ||
665 | val &= ~bm; | ||
666 | val |= div << bp; | ||
667 | writel_relaxed(val, reg); | ||
668 | |||
669 | return 0; | ||
670 | } | ||
671 | |||
672 | #define pll2_bus_get_rate pll_get_rate | ||
673 | #define pll2_bus_set_rate pll_set_rate | ||
674 | #define pll3_usb_otg_get_rate pll_get_rate | ||
675 | #define pll3_usb_otg_set_rate pll_set_rate | ||
676 | #define pll7_usb_host_get_rate pll_get_rate | ||
677 | #define pll7_usb_host_set_rate pll_set_rate | ||
678 | #define pll4_audio_get_rate pll_av_get_rate | ||
679 | #define pll4_audio_set_rate pll_av_set_rate | ||
680 | #define pll5_video_get_rate pll_av_get_rate | ||
681 | #define pll5_video_set_rate pll_av_set_rate | ||
682 | #define pll6_mlb_get_rate NULL | ||
683 | #define pll6_mlb_set_rate NULL | ||
684 | |||
685 | #define DEF_PLL(name) \ | ||
686 | static struct clk name = { \ | ||
687 | .enable = pll_enable, \ | ||
688 | .disable = pll_disable, \ | ||
689 | .get_rate = name##_get_rate, \ | ||
690 | .set_rate = name##_set_rate, \ | ||
691 | .parent = &osc_clk, \ | ||
692 | } | ||
693 | |||
694 | DEF_PLL(pll1_sys); | ||
695 | DEF_PLL(pll2_bus); | ||
696 | DEF_PLL(pll3_usb_otg); | ||
697 | DEF_PLL(pll4_audio); | ||
698 | DEF_PLL(pll5_video); | ||
699 | DEF_PLL(pll6_mlb); | ||
700 | DEF_PLL(pll7_usb_host); | ||
701 | DEF_PLL(pll8_enet); | ||
702 | |||
703 | static unsigned long pfd_get_rate(struct clk *clk) | ||
704 | { | ||
705 | u64 tmp = (u64) clk_get_rate(clk->parent) * 18; | ||
706 | u32 frac, bp_frac; | ||
707 | |||
708 | if (apbh_dma_clk.usecount == 0) | ||
709 | apbh_dma_clk.enable(&apbh_dma_clk); | ||
710 | |||
711 | bp_frac = clk->enable_shift - 7; | ||
712 | frac = readl_relaxed(clk->enable_reg) >> bp_frac & PFD_FRAC_MASK; | ||
713 | do_div(tmp, frac); | ||
714 | |||
715 | return tmp; | ||
716 | } | ||
717 | |||
718 | static int pfd_set_rate(struct clk *clk, unsigned long rate) | ||
719 | { | ||
720 | u32 val, frac, bp_frac; | ||
721 | u64 tmp = (u64) clk_get_rate(clk->parent) * 18; | ||
722 | |||
723 | if (apbh_dma_clk.usecount == 0) | ||
724 | apbh_dma_clk.enable(&apbh_dma_clk); | ||
725 | |||
726 | /* | ||
727 | * Round up the divider so that we don't set a rate | ||
728 | * higher than what is requested | ||
729 | */ | ||
730 | tmp += rate / 2; | ||
731 | do_div(tmp, rate); | ||
732 | frac = tmp; | ||
733 | frac = (frac < 12) ? 12 : frac; | ||
734 | frac = (frac > 35) ? 35 : frac; | ||
735 | |||
736 | /* | ||
737 | * The frac field always starts from 7 bits lower | ||
738 | * position of enable bit | ||
739 | */ | ||
740 | bp_frac = clk->enable_shift - 7; | ||
741 | val = readl_relaxed(clk->enable_reg); | ||
742 | val &= ~(PFD_FRAC_MASK << bp_frac); | ||
743 | val |= frac << bp_frac; | ||
744 | writel_relaxed(val, clk->enable_reg); | ||
745 | |||
746 | tmp = (u64) clk_get_rate(clk->parent) * 18; | ||
747 | do_div(tmp, frac); | ||
748 | |||
749 | if (apbh_dma_clk.usecount == 0) | ||
750 | apbh_dma_clk.disable(&apbh_dma_clk); | ||
751 | |||
752 | return 0; | ||
753 | } | ||
754 | |||
755 | static unsigned long pfd_round_rate(struct clk *clk, unsigned long rate) | ||
756 | { | ||
757 | u32 frac; | ||
758 | u64 tmp; | ||
759 | |||
760 | tmp = (u64) clk_get_rate(clk->parent) * 18; | ||
761 | tmp += rate / 2; | ||
762 | do_div(tmp, rate); | ||
763 | frac = tmp; | ||
764 | frac = (frac < 12) ? 12 : frac; | ||
765 | frac = (frac > 35) ? 35 : frac; | ||
766 | tmp = (u64) clk_get_rate(clk->parent) * 18; | ||
767 | do_div(tmp, frac); | ||
768 | |||
769 | return tmp; | ||
770 | } | ||
771 | |||
772 | static int pfd_enable(struct clk *clk) | ||
773 | { | ||
774 | u32 val; | ||
775 | |||
776 | if (apbh_dma_clk.usecount == 0) | ||
777 | apbh_dma_clk.enable(&apbh_dma_clk); | ||
778 | |||
779 | val = readl_relaxed(clk->enable_reg); | ||
780 | val &= ~(1 << clk->enable_shift); | ||
781 | writel_relaxed(val, clk->enable_reg); | ||
782 | |||
783 | if (apbh_dma_clk.usecount == 0) | ||
784 | apbh_dma_clk.disable(&apbh_dma_clk); | ||
785 | |||
786 | return 0; | ||
787 | } | ||
788 | |||
789 | static void pfd_disable(struct clk *clk) | ||
790 | { | ||
791 | u32 val; | ||
792 | |||
793 | if (apbh_dma_clk.usecount == 0) | ||
794 | apbh_dma_clk.enable(&apbh_dma_clk); | ||
795 | |||
796 | val = readl_relaxed(clk->enable_reg); | ||
797 | val |= 1 << clk->enable_shift; | ||
798 | writel_relaxed(val, clk->enable_reg); | ||
799 | |||
800 | if (apbh_dma_clk.usecount == 0) | ||
801 | apbh_dma_clk.disable(&apbh_dma_clk); | ||
802 | } | ||
803 | |||
804 | #define DEF_PFD(name, er, es, p) \ | ||
805 | static struct clk name = { \ | ||
806 | .enable_reg = er, \ | ||
807 | .enable_shift = es, \ | ||
808 | .enable = pfd_enable, \ | ||
809 | .disable = pfd_disable, \ | ||
810 | .get_rate = pfd_get_rate, \ | ||
811 | .set_rate = pfd_set_rate, \ | ||
812 | .round_rate = pfd_round_rate, \ | ||
813 | .parent = p, \ | ||
814 | } | ||
815 | |||
816 | DEF_PFD(pll2_pfd_352m, PFD_528, PFD0, &pll2_bus); | ||
817 | DEF_PFD(pll2_pfd_594m, PFD_528, PFD1, &pll2_bus); | ||
818 | DEF_PFD(pll2_pfd_400m, PFD_528, PFD2, &pll2_bus); | ||
819 | DEF_PFD(pll3_pfd_720m, PFD_480, PFD0, &pll3_usb_otg); | ||
820 | DEF_PFD(pll3_pfd_540m, PFD_480, PFD1, &pll3_usb_otg); | ||
821 | DEF_PFD(pll3_pfd_508m, PFD_480, PFD2, &pll3_usb_otg); | ||
822 | DEF_PFD(pll3_pfd_454m, PFD_480, PFD3, &pll3_usb_otg); | ||
823 | |||
824 | static unsigned long twd_clk_get_rate(struct clk *clk) | ||
825 | { | ||
826 | return clk_get_rate(clk->parent) / 2; | ||
827 | } | ||
828 | |||
829 | static struct clk twd_clk = { | ||
830 | .parent = &arm_clk, | ||
831 | .get_rate = twd_clk_get_rate, | ||
832 | }; | ||
833 | |||
834 | static unsigned long pll2_200m_get_rate(struct clk *clk) | ||
835 | { | ||
836 | return clk_get_rate(clk->parent) / 2; | ||
837 | } | ||
838 | |||
839 | static struct clk pll2_200m = { | ||
840 | .parent = &pll2_pfd_400m, | ||
841 | .get_rate = pll2_200m_get_rate, | ||
842 | }; | ||
843 | |||
844 | static unsigned long pll3_120m_get_rate(struct clk *clk) | ||
845 | { | ||
846 | return clk_get_rate(clk->parent) / 4; | ||
847 | } | ||
848 | |||
849 | static struct clk pll3_120m = { | ||
850 | .parent = &pll3_usb_otg, | ||
851 | .get_rate = pll3_120m_get_rate, | ||
852 | }; | ||
853 | |||
854 | static unsigned long pll3_80m_get_rate(struct clk *clk) | ||
855 | { | ||
856 | return clk_get_rate(clk->parent) / 6; | ||
857 | } | ||
858 | |||
859 | static struct clk pll3_80m = { | ||
860 | .parent = &pll3_usb_otg, | ||
861 | .get_rate = pll3_80m_get_rate, | ||
862 | }; | ||
863 | |||
864 | static unsigned long pll3_60m_get_rate(struct clk *clk) | ||
865 | { | ||
866 | return clk_get_rate(clk->parent) / 8; | ||
867 | } | ||
868 | |||
869 | static struct clk pll3_60m = { | ||
870 | .parent = &pll3_usb_otg, | ||
871 | .get_rate = pll3_60m_get_rate, | ||
872 | }; | ||
873 | |||
874 | static int pll1_sw_clk_set_parent(struct clk *clk, struct clk *parent) | ||
875 | { | ||
876 | u32 val = readl_relaxed(CCSR); | ||
877 | |||
878 | if (parent == &pll1_sys) { | ||
879 | val &= ~BM_CCSR_PLL1_SW_SEL; | ||
880 | val &= ~BM_CCSR_STEP_SEL; | ||
881 | } else if (parent == &osc_clk) { | ||
882 | val |= BM_CCSR_PLL1_SW_SEL; | ||
883 | val &= ~BM_CCSR_STEP_SEL; | ||
884 | } else if (parent == &pll2_pfd_400m) { | ||
885 | val |= BM_CCSR_PLL1_SW_SEL; | ||
886 | val |= BM_CCSR_STEP_SEL; | ||
887 | } else { | ||
888 | return -EINVAL; | ||
889 | } | ||
890 | |||
891 | writel_relaxed(val, CCSR); | ||
892 | |||
893 | return 0; | ||
894 | } | ||
895 | |||
896 | static struct clk pll1_sw_clk = { | ||
897 | .parent = &pll1_sys, | ||
898 | .set_parent = pll1_sw_clk_set_parent, | ||
899 | }; | ||
900 | |||
901 | static void calc_pred_podf_dividers(u32 div, u32 *pred, u32 *podf) | ||
902 | { | ||
903 | u32 min_pred, temp_pred, old_err, err; | ||
904 | |||
905 | if (div >= 512) { | ||
906 | *pred = 8; | ||
907 | *podf = 64; | ||
908 | } else if (div >= 8) { | ||
909 | min_pred = (div - 1) / 64 + 1; | ||
910 | old_err = 8; | ||
911 | for (temp_pred = 8; temp_pred >= min_pred; temp_pred--) { | ||
912 | err = div % temp_pred; | ||
913 | if (err == 0) { | ||
914 | *pred = temp_pred; | ||
915 | break; | ||
916 | } | ||
917 | err = temp_pred - err; | ||
918 | if (err < old_err) { | ||
919 | old_err = err; | ||
920 | *pred = temp_pred; | ||
921 | } | ||
922 | } | ||
923 | *podf = (div + *pred - 1) / *pred; | ||
924 | } else if (div < 8) { | ||
925 | *pred = div; | ||
926 | *podf = 1; | ||
927 | } | ||
928 | } | ||
929 | |||
930 | static int _clk_enable(struct clk *clk) | ||
931 | { | ||
932 | u32 reg; | ||
933 | reg = readl_relaxed(clk->enable_reg); | ||
934 | reg |= 0x3 << clk->enable_shift; | ||
935 | writel_relaxed(reg, clk->enable_reg); | ||
936 | |||
937 | return 0; | ||
938 | } | ||
939 | |||
940 | static void _clk_disable(struct clk *clk) | ||
941 | { | ||
942 | u32 reg; | ||
943 | reg = readl_relaxed(clk->enable_reg); | ||
944 | reg &= ~(0x3 << clk->enable_shift); | ||
945 | writel_relaxed(reg, clk->enable_reg); | ||
946 | } | ||
947 | |||
948 | static int _clk_enable_1b(struct clk *clk) | ||
949 | { | ||
950 | u32 reg; | ||
951 | reg = readl_relaxed(clk->enable_reg); | ||
952 | reg |= 0x1 << clk->enable_shift; | ||
953 | writel_relaxed(reg, clk->enable_reg); | ||
954 | |||
955 | return 0; | ||
956 | } | ||
957 | |||
958 | static void _clk_disable_1b(struct clk *clk) | ||
959 | { | ||
960 | u32 reg; | ||
961 | reg = readl_relaxed(clk->enable_reg); | ||
962 | reg &= ~(0x1 << clk->enable_shift); | ||
963 | writel_relaxed(reg, clk->enable_reg); | ||
964 | } | ||
965 | |||
966 | struct divider { | ||
967 | struct clk *clk; | ||
968 | void __iomem *reg; | ||
969 | u32 bp_pred; | ||
970 | u32 bm_pred; | ||
971 | u32 bp_podf; | ||
972 | u32 bm_podf; | ||
973 | }; | ||
974 | |||
975 | #define DEF_CLK_DIV1(d, c, r, b) \ | ||
976 | static struct divider d = { \ | ||
977 | .clk = c, \ | ||
978 | .reg = r, \ | ||
979 | .bp_podf = BP_##r##_##b##_PODF, \ | ||
980 | .bm_podf = BM_##r##_##b##_PODF, \ | ||
981 | } | ||
982 | |||
983 | DEF_CLK_DIV1(arm_div, &arm_clk, CACRR, ARM); | ||
984 | DEF_CLK_DIV1(ipg_div, &ipg_clk, CBCDR, IPG); | ||
985 | DEF_CLK_DIV1(ahb_div, &ahb_clk, CBCDR, AHB); | ||
986 | DEF_CLK_DIV1(axi_div, &axi_clk, CBCDR, AXI); | ||
987 | DEF_CLK_DIV1(mmdc_ch0_axi_div, &mmdc_ch0_axi_clk, CBCDR, MMDC_CH0_AXI); | ||
988 | DEF_CLK_DIV1(mmdc_ch1_axi_div, &mmdc_ch1_axi_clk, CBCDR, MMDC_CH1_AXI); | ||
989 | DEF_CLK_DIV1(periph_clk2_div, &periph_clk2_clk, CBCDR, PERIPH_CLK2); | ||
990 | DEF_CLK_DIV1(periph2_clk2_div, &periph2_clk2_clk, CBCDR, PERIPH2_CLK2); | ||
991 | DEF_CLK_DIV1(gpu2d_core_div, &gpu2d_core_clk, CBCMR, GPU2D_CORE); | ||
992 | DEF_CLK_DIV1(gpu3d_core_div, &gpu3d_core_clk, CBCMR, GPU3D_CORE); | ||
993 | DEF_CLK_DIV1(gpu3d_shader_div, &gpu3d_shader_clk, CBCMR, GPU3D_SHADER); | ||
994 | DEF_CLK_DIV1(ipg_perclk_div, &ipg_perclk, CSCMR1, PERCLK); | ||
995 | DEF_CLK_DIV1(emi_div, &emi_clk, CSCMR1, EMI); | ||
996 | DEF_CLK_DIV1(emi_slow_div, &emi_slow_clk, CSCMR1, EMI_SLOW); | ||
997 | DEF_CLK_DIV1(can_div, &can1_clk, CSCMR2, CAN); | ||
998 | DEF_CLK_DIV1(uart_div, &uart_clk, CSCDR1, UART); | ||
999 | DEF_CLK_DIV1(usdhc1_div, &usdhc1_clk, CSCDR1, USDHC1); | ||
1000 | DEF_CLK_DIV1(usdhc2_div, &usdhc2_clk, CSCDR1, USDHC2); | ||
1001 | DEF_CLK_DIV1(usdhc3_div, &usdhc3_clk, CSCDR1, USDHC3); | ||
1002 | DEF_CLK_DIV1(usdhc4_div, &usdhc4_clk, CSCDR1, USDHC4); | ||
1003 | DEF_CLK_DIV1(vpu_div, &vpu_clk, CSCDR1, VPU_AXI); | ||
1004 | DEF_CLK_DIV1(hsi_tx_div, &hsi_tx_clk, CDCDR, HSI_TX); | ||
1005 | DEF_CLK_DIV1(ipu1_di0_pre_div, &ipu1_di0_pre_clk, CHSCCDR, IPU1_DI0_PRE); | ||
1006 | DEF_CLK_DIV1(ipu1_di1_pre_div, &ipu1_di1_pre_clk, CHSCCDR, IPU1_DI1_PRE); | ||
1007 | DEF_CLK_DIV1(ipu2_di0_pre_div, &ipu2_di0_pre_clk, CSCDR2, IPU2_DI0_PRE); | ||
1008 | DEF_CLK_DIV1(ipu2_di1_pre_div, &ipu2_di1_pre_clk, CSCDR2, IPU2_DI1_PRE); | ||
1009 | DEF_CLK_DIV1(ipu1_div, &ipu1_clk, CSCDR3, IPU1_HSP); | ||
1010 | DEF_CLK_DIV1(ipu2_div, &ipu2_clk, CSCDR3, IPU2_HSP); | ||
1011 | DEF_CLK_DIV1(cko1_div, &cko1_clk, CCOSR, CKO1); | ||
1012 | |||
1013 | #define DEF_CLK_DIV2(d, c, r, b) \ | ||
1014 | static struct divider d = { \ | ||
1015 | .clk = c, \ | ||
1016 | .reg = r, \ | ||
1017 | .bp_pred = BP_##r##_##b##_PRED, \ | ||
1018 | .bm_pred = BM_##r##_##b##_PRED, \ | ||
1019 | .bp_podf = BP_##r##_##b##_PODF, \ | ||
1020 | .bm_podf = BM_##r##_##b##_PODF, \ | ||
1021 | } | ||
1022 | |||
1023 | DEF_CLK_DIV2(ssi1_div, &ssi1_clk, CS1CDR, SSI1); | ||
1024 | DEF_CLK_DIV2(ssi3_div, &ssi3_clk, CS1CDR, SSI3); | ||
1025 | DEF_CLK_DIV2(esai_div, &esai_clk, CS1CDR, ESAI); | ||
1026 | DEF_CLK_DIV2(ssi2_div, &ssi2_clk, CS2CDR, SSI2); | ||
1027 | DEF_CLK_DIV2(enfc_div, &enfc_clk, CS2CDR, ENFC); | ||
1028 | DEF_CLK_DIV2(spdif_div, &spdif_clk, CDCDR, SPDIF); | ||
1029 | DEF_CLK_DIV2(asrc_serial_div, &asrc_serial_clk, CDCDR, ASRC_SERIAL); | ||
1030 | |||
1031 | static struct divider *dividers[] = { | ||
1032 | &arm_div, | ||
1033 | &ipg_div, | ||
1034 | &ahb_div, | ||
1035 | &axi_div, | ||
1036 | &mmdc_ch0_axi_div, | ||
1037 | &mmdc_ch1_axi_div, | ||
1038 | &periph_clk2_div, | ||
1039 | &periph2_clk2_div, | ||
1040 | &gpu2d_core_div, | ||
1041 | &gpu3d_core_div, | ||
1042 | &gpu3d_shader_div, | ||
1043 | &ipg_perclk_div, | ||
1044 | &emi_div, | ||
1045 | &emi_slow_div, | ||
1046 | &can_div, | ||
1047 | &uart_div, | ||
1048 | &usdhc1_div, | ||
1049 | &usdhc2_div, | ||
1050 | &usdhc3_div, | ||
1051 | &usdhc4_div, | ||
1052 | &vpu_div, | ||
1053 | &hsi_tx_div, | ||
1054 | &ipu1_di0_pre_div, | ||
1055 | &ipu1_di1_pre_div, | ||
1056 | &ipu2_di0_pre_div, | ||
1057 | &ipu2_di1_pre_div, | ||
1058 | &ipu1_div, | ||
1059 | &ipu2_div, | ||
1060 | &ssi1_div, | ||
1061 | &ssi3_div, | ||
1062 | &esai_div, | ||
1063 | &ssi2_div, | ||
1064 | &enfc_div, | ||
1065 | &spdif_div, | ||
1066 | &asrc_serial_div, | ||
1067 | &cko1_div, | ||
1068 | }; | ||
1069 | |||
1070 | static unsigned long ldb_di_clk_get_rate(struct clk *clk) | ||
1071 | { | ||
1072 | u32 val = readl_relaxed(CSCMR2); | ||
1073 | |||
1074 | val &= (clk == &ldb_di0_clk) ? BM_CSCMR2_LDB_DI0_IPU_DIV : | ||
1075 | BM_CSCMR2_LDB_DI1_IPU_DIV; | ||
1076 | if (val) | ||
1077 | return clk_get_rate(clk->parent) / 7; | ||
1078 | else | ||
1079 | return clk_get_rate(clk->parent) * 2 / 7; | ||
1080 | } | ||
1081 | |||
1082 | static int ldb_di_clk_set_rate(struct clk *clk, unsigned long rate) | ||
1083 | { | ||
1084 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
1085 | u32 val = readl_relaxed(CSCMR2); | ||
1086 | |||
1087 | if (rate * 7 <= parent_rate + parent_rate / 20) | ||
1088 | val |= BM_CSCMR2_LDB_DI0_IPU_DIV; | ||
1089 | else | ||
1090 | val &= ~BM_CSCMR2_LDB_DI0_IPU_DIV; | ||
1091 | |||
1092 | writel_relaxed(val, CSCMR2); | ||
1093 | |||
1094 | return 0; | ||
1095 | } | ||
1096 | |||
1097 | static unsigned long ldb_di_clk_round_rate(struct clk *clk, unsigned long rate) | ||
1098 | { | ||
1099 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
1100 | |||
1101 | if (rate * 7 <= parent_rate + parent_rate / 20) | ||
1102 | return parent_rate / 7; | ||
1103 | else | ||
1104 | return 2 * parent_rate / 7; | ||
1105 | } | ||
1106 | |||
1107 | static unsigned long _clk_get_rate(struct clk *clk) | ||
1108 | { | ||
1109 | struct divider *d; | ||
1110 | u32 val, pred, podf; | ||
1111 | int i, num; | ||
1112 | |||
1113 | if (clk == &ldb_di0_clk || clk == &ldb_di1_clk) | ||
1114 | return ldb_di_clk_get_rate(clk); | ||
1115 | |||
1116 | num = ARRAY_SIZE(dividers); | ||
1117 | for (i = 0; i < num; i++) | ||
1118 | if (dividers[i]->clk == clk) { | ||
1119 | d = dividers[i]; | ||
1120 | break; | ||
1121 | } | ||
1122 | if (i == num) | ||
1123 | return clk_get_rate(clk->parent); | ||
1124 | |||
1125 | val = readl_relaxed(d->reg); | ||
1126 | pred = ((val & d->bm_pred) >> d->bp_pred) + 1; | ||
1127 | podf = ((val & d->bm_podf) >> d->bp_podf) + 1; | ||
1128 | |||
1129 | return clk_get_rate(clk->parent) / (pred * podf); | ||
1130 | } | ||
1131 | |||
1132 | static int clk_busy_wait(struct clk *clk) | ||
1133 | { | ||
1134 | int timeout = 0x100000; | ||
1135 | u32 bm; | ||
1136 | |||
1137 | if (clk == &axi_clk) | ||
1138 | bm = BM_CDHIPR_AXI_PODF_BUSY; | ||
1139 | else if (clk == &ahb_clk) | ||
1140 | bm = BM_CDHIPR_AHB_PODF_BUSY; | ||
1141 | else if (clk == &mmdc_ch0_axi_clk) | ||
1142 | bm = BM_CDHIPR_MMDC_CH0_PODF_BUSY; | ||
1143 | else if (clk == &periph_clk) | ||
1144 | bm = BM_CDHIPR_PERIPH_SEL_BUSY; | ||
1145 | else if (clk == &arm_clk) | ||
1146 | bm = BM_CDHIPR_ARM_PODF_BUSY; | ||
1147 | else | ||
1148 | return -EINVAL; | ||
1149 | |||
1150 | while ((readl_relaxed(CDHIPR) & bm) && --timeout) | ||
1151 | cpu_relax(); | ||
1152 | |||
1153 | if (unlikely(!timeout)) | ||
1154 | return -EBUSY; | ||
1155 | |||
1156 | return 0; | ||
1157 | } | ||
1158 | |||
1159 | static int _clk_set_rate(struct clk *clk, unsigned long rate) | ||
1160 | { | ||
1161 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
1162 | struct divider *d; | ||
1163 | u32 val, div, max_div, pred = 0, podf; | ||
1164 | int i, num; | ||
1165 | |||
1166 | if (clk == &ldb_di0_clk || clk == &ldb_di1_clk) | ||
1167 | return ldb_di_clk_set_rate(clk, rate); | ||
1168 | |||
1169 | num = ARRAY_SIZE(dividers); | ||
1170 | for (i = 0; i < num; i++) | ||
1171 | if (dividers[i]->clk == clk) { | ||
1172 | d = dividers[i]; | ||
1173 | break; | ||
1174 | } | ||
1175 | if (i == num) | ||
1176 | return -EINVAL; | ||
1177 | |||
1178 | max_div = ((d->bm_pred >> d->bp_pred) + 1) * | ||
1179 | ((d->bm_podf >> d->bp_podf) + 1); | ||
1180 | |||
1181 | div = parent_rate / rate; | ||
1182 | if (div == 0) | ||
1183 | div++; | ||
1184 | |||
1185 | if ((parent_rate / div != rate) || div > max_div) | ||
1186 | return -EINVAL; | ||
1187 | |||
1188 | if (d->bm_pred) { | ||
1189 | calc_pred_podf_dividers(div, &pred, &podf); | ||
1190 | } else { | ||
1191 | pred = 1; | ||
1192 | podf = div; | ||
1193 | } | ||
1194 | |||
1195 | val = readl_relaxed(d->reg); | ||
1196 | val &= ~(d->bm_pred | d->bm_podf); | ||
1197 | val |= (pred - 1) << d->bp_pred | (podf - 1) << d->bp_podf; | ||
1198 | writel_relaxed(val, d->reg); | ||
1199 | |||
1200 | if (clk == &axi_clk || clk == &ahb_clk || | ||
1201 | clk == &mmdc_ch0_axi_clk || clk == &arm_clk) | ||
1202 | return clk_busy_wait(clk); | ||
1203 | |||
1204 | return 0; | ||
1205 | } | ||
1206 | |||
1207 | static unsigned long _clk_round_rate(struct clk *clk, unsigned long rate) | ||
1208 | { | ||
1209 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
1210 | u32 div = parent_rate / rate; | ||
1211 | u32 div_max, pred = 0, podf; | ||
1212 | struct divider *d; | ||
1213 | int i, num; | ||
1214 | |||
1215 | if (clk == &ldb_di0_clk || clk == &ldb_di1_clk) | ||
1216 | return ldb_di_clk_round_rate(clk, rate); | ||
1217 | |||
1218 | num = ARRAY_SIZE(dividers); | ||
1219 | for (i = 0; i < num; i++) | ||
1220 | if (dividers[i]->clk == clk) { | ||
1221 | d = dividers[i]; | ||
1222 | break; | ||
1223 | } | ||
1224 | if (i == num) | ||
1225 | return -EINVAL; | ||
1226 | |||
1227 | if (div == 0 || parent_rate % rate) | ||
1228 | div++; | ||
1229 | |||
1230 | if (d->bm_pred) { | ||
1231 | calc_pred_podf_dividers(div, &pred, &podf); | ||
1232 | div = pred * podf; | ||
1233 | } else { | ||
1234 | div_max = (d->bm_podf >> d->bp_podf) + 1; | ||
1235 | if (div > div_max) | ||
1236 | div = div_max; | ||
1237 | } | ||
1238 | |||
1239 | return parent_rate / div; | ||
1240 | } | ||
1241 | |||
1242 | struct multiplexer { | ||
1243 | struct clk *clk; | ||
1244 | void __iomem *reg; | ||
1245 | u32 bp; | ||
1246 | u32 bm; | ||
1247 | int pnum; | ||
1248 | struct clk *parents[]; | ||
1249 | }; | ||
1250 | |||
1251 | static struct multiplexer axi_mux = { | ||
1252 | .clk = &axi_clk, | ||
1253 | .reg = CBCDR, | ||
1254 | .bp = BP_CBCDR_AXI_SEL, | ||
1255 | .bm = BM_CBCDR_AXI_SEL, | ||
1256 | .parents = { | ||
1257 | &periph_clk, | ||
1258 | &pll2_pfd_400m, | ||
1259 | &pll3_pfd_540m, | ||
1260 | NULL | ||
1261 | }, | ||
1262 | }; | ||
1263 | |||
1264 | static struct multiplexer periph_mux = { | ||
1265 | .clk = &periph_clk, | ||
1266 | .reg = CBCDR, | ||
1267 | .bp = BP_CBCDR_PERIPH_CLK_SEL, | ||
1268 | .bm = BM_CBCDR_PERIPH_CLK_SEL, | ||
1269 | .parents = { | ||
1270 | &periph_pre_clk, | ||
1271 | &periph_clk2_clk, | ||
1272 | NULL | ||
1273 | }, | ||
1274 | }; | ||
1275 | |||
1276 | static struct multiplexer periph_pre_mux = { | ||
1277 | .clk = &periph_pre_clk, | ||
1278 | .reg = CBCMR, | ||
1279 | .bp = BP_CBCMR_PRE_PERIPH_CLK_SEL, | ||
1280 | .bm = BM_CBCMR_PRE_PERIPH_CLK_SEL, | ||
1281 | .parents = { | ||
1282 | &pll2_bus, | ||
1283 | &pll2_pfd_400m, | ||
1284 | &pll2_pfd_352m, | ||
1285 | &pll2_200m, | ||
1286 | NULL | ||
1287 | }, | ||
1288 | }; | ||
1289 | |||
1290 | static struct multiplexer periph_clk2_mux = { | ||
1291 | .clk = &periph_clk2_clk, | ||
1292 | .reg = CBCMR, | ||
1293 | .bp = BP_CBCMR_PERIPH_CLK2_SEL, | ||
1294 | .bm = BM_CBCMR_PERIPH_CLK2_SEL, | ||
1295 | .parents = { | ||
1296 | &pll3_usb_otg, | ||
1297 | &osc_clk, | ||
1298 | NULL | ||
1299 | }, | ||
1300 | }; | ||
1301 | |||
1302 | static struct multiplexer periph2_mux = { | ||
1303 | .clk = &periph2_clk, | ||
1304 | .reg = CBCDR, | ||
1305 | .bp = BP_CBCDR_PERIPH2_CLK_SEL, | ||
1306 | .bm = BM_CBCDR_PERIPH2_CLK_SEL, | ||
1307 | .parents = { | ||
1308 | &periph2_pre_clk, | ||
1309 | &periph2_clk2_clk, | ||
1310 | NULL | ||
1311 | }, | ||
1312 | }; | ||
1313 | |||
1314 | static struct multiplexer periph2_pre_mux = { | ||
1315 | .clk = &periph2_pre_clk, | ||
1316 | .reg = CBCMR, | ||
1317 | .bp = BP_CBCMR_PRE_PERIPH2_CLK_SEL, | ||
1318 | .bm = BM_CBCMR_PRE_PERIPH2_CLK_SEL, | ||
1319 | .parents = { | ||
1320 | &pll2_bus, | ||
1321 | &pll2_pfd_400m, | ||
1322 | &pll2_pfd_352m, | ||
1323 | &pll2_200m, | ||
1324 | NULL | ||
1325 | }, | ||
1326 | }; | ||
1327 | |||
1328 | static struct multiplexer periph2_clk2_mux = { | ||
1329 | .clk = &periph2_clk2_clk, | ||
1330 | .reg = CBCMR, | ||
1331 | .bp = BP_CBCMR_PERIPH2_CLK2_SEL, | ||
1332 | .bm = BM_CBCMR_PERIPH2_CLK2_SEL, | ||
1333 | .parents = { | ||
1334 | &pll3_usb_otg, | ||
1335 | &osc_clk, | ||
1336 | NULL | ||
1337 | }, | ||
1338 | }; | ||
1339 | |||
1340 | static struct multiplexer gpu2d_axi_mux = { | ||
1341 | .clk = &gpu2d_axi_clk, | ||
1342 | .reg = CBCMR, | ||
1343 | .bp = BP_CBCMR_GPU2D_AXI_SEL, | ||
1344 | .bm = BM_CBCMR_GPU2D_AXI_SEL, | ||
1345 | .parents = { | ||
1346 | &axi_clk, | ||
1347 | &ahb_clk, | ||
1348 | NULL | ||
1349 | }, | ||
1350 | }; | ||
1351 | |||
1352 | static struct multiplexer gpu3d_axi_mux = { | ||
1353 | .clk = &gpu3d_axi_clk, | ||
1354 | .reg = CBCMR, | ||
1355 | .bp = BP_CBCMR_GPU3D_AXI_SEL, | ||
1356 | .bm = BM_CBCMR_GPU3D_AXI_SEL, | ||
1357 | .parents = { | ||
1358 | &axi_clk, | ||
1359 | &ahb_clk, | ||
1360 | NULL | ||
1361 | }, | ||
1362 | }; | ||
1363 | |||
1364 | static struct multiplexer gpu3d_core_mux = { | ||
1365 | .clk = &gpu3d_core_clk, | ||
1366 | .reg = CBCMR, | ||
1367 | .bp = BP_CBCMR_GPU3D_CORE_SEL, | ||
1368 | .bm = BM_CBCMR_GPU3D_CORE_SEL, | ||
1369 | .parents = { | ||
1370 | &mmdc_ch0_axi_clk, | ||
1371 | &pll3_usb_otg, | ||
1372 | &pll2_pfd_594m, | ||
1373 | &pll2_pfd_400m, | ||
1374 | NULL | ||
1375 | }, | ||
1376 | }; | ||
1377 | |||
1378 | static struct multiplexer gpu3d_shader_mux = { | ||
1379 | .clk = &gpu3d_shader_clk, | ||
1380 | .reg = CBCMR, | ||
1381 | .bp = BP_CBCMR_GPU3D_SHADER_SEL, | ||
1382 | .bm = BM_CBCMR_GPU3D_SHADER_SEL, | ||
1383 | .parents = { | ||
1384 | &mmdc_ch0_axi_clk, | ||
1385 | &pll3_usb_otg, | ||
1386 | &pll2_pfd_594m, | ||
1387 | &pll3_pfd_720m, | ||
1388 | NULL | ||
1389 | }, | ||
1390 | }; | ||
1391 | |||
1392 | static struct multiplexer pcie_axi_mux = { | ||
1393 | .clk = &pcie_clk, | ||
1394 | .reg = CBCMR, | ||
1395 | .bp = BP_CBCMR_PCIE_AXI_SEL, | ||
1396 | .bm = BM_CBCMR_PCIE_AXI_SEL, | ||
1397 | .parents = { | ||
1398 | &axi_clk, | ||
1399 | &ahb_clk, | ||
1400 | NULL | ||
1401 | }, | ||
1402 | }; | ||
1403 | |||
1404 | static struct multiplexer vdo_axi_mux = { | ||
1405 | .clk = &vdo_axi_clk, | ||
1406 | .reg = CBCMR, | ||
1407 | .bp = BP_CBCMR_VDO_AXI_SEL, | ||
1408 | .bm = BM_CBCMR_VDO_AXI_SEL, | ||
1409 | .parents = { | ||
1410 | &axi_clk, | ||
1411 | &ahb_clk, | ||
1412 | NULL | ||
1413 | }, | ||
1414 | }; | ||
1415 | |||
1416 | static struct multiplexer vpu_axi_mux = { | ||
1417 | .clk = &vpu_clk, | ||
1418 | .reg = CBCMR, | ||
1419 | .bp = BP_CBCMR_VPU_AXI_SEL, | ||
1420 | .bm = BM_CBCMR_VPU_AXI_SEL, | ||
1421 | .parents = { | ||
1422 | &axi_clk, | ||
1423 | &pll2_pfd_400m, | ||
1424 | &pll2_pfd_352m, | ||
1425 | NULL | ||
1426 | }, | ||
1427 | }; | ||
1428 | |||
1429 | static struct multiplexer gpu2d_core_mux = { | ||
1430 | .clk = &gpu2d_core_clk, | ||
1431 | .reg = CBCMR, | ||
1432 | .bp = BP_CBCMR_GPU2D_CORE_SEL, | ||
1433 | .bm = BM_CBCMR_GPU2D_CORE_SEL, | ||
1434 | .parents = { | ||
1435 | &axi_clk, | ||
1436 | &pll3_usb_otg, | ||
1437 | &pll2_pfd_352m, | ||
1438 | &pll2_pfd_400m, | ||
1439 | NULL | ||
1440 | }, | ||
1441 | }; | ||
1442 | |||
1443 | #define DEF_SSI_MUX(id) \ | ||
1444 | static struct multiplexer ssi##id##_mux = { \ | ||
1445 | .clk = &ssi##id##_clk, \ | ||
1446 | .reg = CSCMR1, \ | ||
1447 | .bp = BP_CSCMR1_SSI##id##_SEL, \ | ||
1448 | .bm = BM_CSCMR1_SSI##id##_SEL, \ | ||
1449 | .parents = { \ | ||
1450 | &pll3_pfd_508m, \ | ||
1451 | &pll3_pfd_454m, \ | ||
1452 | &pll4_audio, \ | ||
1453 | NULL \ | ||
1454 | }, \ | ||
1455 | } | ||
1456 | |||
1457 | DEF_SSI_MUX(1); | ||
1458 | DEF_SSI_MUX(2); | ||
1459 | DEF_SSI_MUX(3); | ||
1460 | |||
1461 | #define DEF_USDHC_MUX(id) \ | ||
1462 | static struct multiplexer usdhc##id##_mux = { \ | ||
1463 | .clk = &usdhc##id##_clk, \ | ||
1464 | .reg = CSCMR1, \ | ||
1465 | .bp = BP_CSCMR1_USDHC##id##_SEL, \ | ||
1466 | .bm = BM_CSCMR1_USDHC##id##_SEL, \ | ||
1467 | .parents = { \ | ||
1468 | &pll2_pfd_400m, \ | ||
1469 | &pll2_pfd_352m, \ | ||
1470 | NULL \ | ||
1471 | }, \ | ||
1472 | } | ||
1473 | |||
1474 | DEF_USDHC_MUX(1); | ||
1475 | DEF_USDHC_MUX(2); | ||
1476 | DEF_USDHC_MUX(3); | ||
1477 | DEF_USDHC_MUX(4); | ||
1478 | |||
1479 | static struct multiplexer emi_mux = { | ||
1480 | .clk = &emi_clk, | ||
1481 | .reg = CSCMR1, | ||
1482 | .bp = BP_CSCMR1_EMI_SEL, | ||
1483 | .bm = BM_CSCMR1_EMI_SEL, | ||
1484 | .parents = { | ||
1485 | &axi_clk, | ||
1486 | &pll3_usb_otg, | ||
1487 | &pll2_pfd_400m, | ||
1488 | &pll2_pfd_352m, | ||
1489 | NULL | ||
1490 | }, | ||
1491 | }; | ||
1492 | |||
1493 | static struct multiplexer emi_slow_mux = { | ||
1494 | .clk = &emi_slow_clk, | ||
1495 | .reg = CSCMR1, | ||
1496 | .bp = BP_CSCMR1_EMI_SLOW_SEL, | ||
1497 | .bm = BM_CSCMR1_EMI_SLOW_SEL, | ||
1498 | .parents = { | ||
1499 | &axi_clk, | ||
1500 | &pll3_usb_otg, | ||
1501 | &pll2_pfd_400m, | ||
1502 | &pll2_pfd_352m, | ||
1503 | NULL | ||
1504 | }, | ||
1505 | }; | ||
1506 | |||
1507 | static struct multiplexer esai_mux = { | ||
1508 | .clk = &esai_clk, | ||
1509 | .reg = CSCMR2, | ||
1510 | .bp = BP_CSCMR2_ESAI_SEL, | ||
1511 | .bm = BM_CSCMR2_ESAI_SEL, | ||
1512 | .parents = { | ||
1513 | &pll4_audio, | ||
1514 | &pll3_pfd_508m, | ||
1515 | &pll3_pfd_454m, | ||
1516 | &pll3_usb_otg, | ||
1517 | NULL | ||
1518 | }, | ||
1519 | }; | ||
1520 | |||
1521 | #define DEF_LDB_DI_MUX(id) \ | ||
1522 | static struct multiplexer ldb_di##id##_mux = { \ | ||
1523 | .clk = &ldb_di##id##_clk, \ | ||
1524 | .reg = CS2CDR, \ | ||
1525 | .bp = BP_CS2CDR_LDB_DI##id##_SEL, \ | ||
1526 | .bm = BM_CS2CDR_LDB_DI##id##_SEL, \ | ||
1527 | .parents = { \ | ||
1528 | &pll5_video, \ | ||
1529 | &pll2_pfd_352m, \ | ||
1530 | &pll2_pfd_400m, \ | ||
1531 | &pll3_pfd_540m, \ | ||
1532 | &pll3_usb_otg, \ | ||
1533 | NULL \ | ||
1534 | }, \ | ||
1535 | } | ||
1536 | |||
1537 | DEF_LDB_DI_MUX(0); | ||
1538 | DEF_LDB_DI_MUX(1); | ||
1539 | |||
1540 | static struct multiplexer enfc_mux = { | ||
1541 | .clk = &enfc_clk, | ||
1542 | .reg = CS2CDR, | ||
1543 | .bp = BP_CS2CDR_ENFC_SEL, | ||
1544 | .bm = BM_CS2CDR_ENFC_SEL, | ||
1545 | .parents = { | ||
1546 | &pll2_pfd_352m, | ||
1547 | &pll2_bus, | ||
1548 | &pll3_usb_otg, | ||
1549 | &pll2_pfd_400m, | ||
1550 | NULL | ||
1551 | }, | ||
1552 | }; | ||
1553 | |||
1554 | static struct multiplexer spdif_mux = { | ||
1555 | .clk = &spdif_clk, | ||
1556 | .reg = CDCDR, | ||
1557 | .bp = BP_CDCDR_SPDIF_SEL, | ||
1558 | .bm = BM_CDCDR_SPDIF_SEL, | ||
1559 | .parents = { | ||
1560 | &pll4_audio, | ||
1561 | &pll3_pfd_508m, | ||
1562 | &pll3_pfd_454m, | ||
1563 | &pll3_usb_otg, | ||
1564 | NULL | ||
1565 | }, | ||
1566 | }; | ||
1567 | |||
1568 | static struct multiplexer asrc_serial_mux = { | ||
1569 | .clk = &asrc_serial_clk, | ||
1570 | .reg = CDCDR, | ||
1571 | .bp = BP_CDCDR_ASRC_SERIAL_SEL, | ||
1572 | .bm = BM_CDCDR_ASRC_SERIAL_SEL, | ||
1573 | .parents = { | ||
1574 | &pll4_audio, | ||
1575 | &pll3_pfd_508m, | ||
1576 | &pll3_pfd_454m, | ||
1577 | &pll3_usb_otg, | ||
1578 | NULL | ||
1579 | }, | ||
1580 | }; | ||
1581 | |||
1582 | static struct multiplexer hsi_tx_mux = { | ||
1583 | .clk = &hsi_tx_clk, | ||
1584 | .reg = CDCDR, | ||
1585 | .bp = BP_CDCDR_HSI_TX_SEL, | ||
1586 | .bm = BM_CDCDR_HSI_TX_SEL, | ||
1587 | .parents = { | ||
1588 | &pll3_120m, | ||
1589 | &pll2_pfd_400m, | ||
1590 | NULL | ||
1591 | }, | ||
1592 | }; | ||
1593 | |||
1594 | #define DEF_IPU_DI_PRE_MUX(r, i, d) \ | ||
1595 | static struct multiplexer ipu##i##_di##d##_pre_mux = { \ | ||
1596 | .clk = &ipu##i##_di##d##_pre_clk, \ | ||
1597 | .reg = r, \ | ||
1598 | .bp = BP_##r##_IPU##i##_DI##d##_PRE_SEL, \ | ||
1599 | .bm = BM_##r##_IPU##i##_DI##d##_PRE_SEL, \ | ||
1600 | .parents = { \ | ||
1601 | &mmdc_ch0_axi_clk, \ | ||
1602 | &pll3_usb_otg, \ | ||
1603 | &pll5_video, \ | ||
1604 | &pll2_pfd_352m, \ | ||
1605 | &pll2_pfd_400m, \ | ||
1606 | &pll3_pfd_540m, \ | ||
1607 | NULL \ | ||
1608 | }, \ | ||
1609 | } | ||
1610 | |||
1611 | DEF_IPU_DI_PRE_MUX(CHSCCDR, 1, 0); | ||
1612 | DEF_IPU_DI_PRE_MUX(CHSCCDR, 1, 1); | ||
1613 | DEF_IPU_DI_PRE_MUX(CSCDR2, 2, 0); | ||
1614 | DEF_IPU_DI_PRE_MUX(CSCDR2, 2, 1); | ||
1615 | |||
1616 | #define DEF_IPU_DI_MUX(r, i, d) \ | ||
1617 | static struct multiplexer ipu##i##_di##d##_mux = { \ | ||
1618 | .clk = &ipu##i##_di##d##_clk, \ | ||
1619 | .reg = r, \ | ||
1620 | .bp = BP_##r##_IPU##i##_DI##d##_SEL, \ | ||
1621 | .bm = BM_##r##_IPU##i##_DI##d##_SEL, \ | ||
1622 | .parents = { \ | ||
1623 | &ipu##i##_di##d##_pre_clk, \ | ||
1624 | &dummy_clk, \ | ||
1625 | &dummy_clk, \ | ||
1626 | &ldb_di0_clk, \ | ||
1627 | &ldb_di1_clk, \ | ||
1628 | NULL \ | ||
1629 | }, \ | ||
1630 | } | ||
1631 | |||
1632 | DEF_IPU_DI_MUX(CHSCCDR, 1, 0); | ||
1633 | DEF_IPU_DI_MUX(CHSCCDR, 1, 1); | ||
1634 | DEF_IPU_DI_MUX(CSCDR2, 2, 0); | ||
1635 | DEF_IPU_DI_MUX(CSCDR2, 2, 1); | ||
1636 | |||
1637 | #define DEF_IPU_MUX(id) \ | ||
1638 | static struct multiplexer ipu##id##_mux = { \ | ||
1639 | .clk = &ipu##id##_clk, \ | ||
1640 | .reg = CSCDR3, \ | ||
1641 | .bp = BP_CSCDR3_IPU##id##_HSP_SEL, \ | ||
1642 | .bm = BM_CSCDR3_IPU##id##_HSP_SEL, \ | ||
1643 | .parents = { \ | ||
1644 | &mmdc_ch0_axi_clk, \ | ||
1645 | &pll2_pfd_400m, \ | ||
1646 | &pll3_120m, \ | ||
1647 | &pll3_pfd_540m, \ | ||
1648 | NULL \ | ||
1649 | }, \ | ||
1650 | } | ||
1651 | |||
1652 | DEF_IPU_MUX(1); | ||
1653 | DEF_IPU_MUX(2); | ||
1654 | |||
1655 | static struct multiplexer cko1_mux = { | ||
1656 | .clk = &cko1_clk, | ||
1657 | .reg = CCOSR, | ||
1658 | .bp = BP_CCOSR_CKO1_SEL, | ||
1659 | .bm = BM_CCOSR_CKO1_SEL, | ||
1660 | .parents = { | ||
1661 | &pll3_usb_otg, | ||
1662 | &pll2_bus, | ||
1663 | &pll1_sys, | ||
1664 | &pll5_video, | ||
1665 | &dummy_clk, | ||
1666 | &axi_clk, | ||
1667 | &enfc_clk, | ||
1668 | &ipu1_di0_clk, | ||
1669 | &ipu1_di1_clk, | ||
1670 | &ipu2_di0_clk, | ||
1671 | &ipu2_di1_clk, | ||
1672 | &ahb_clk, | ||
1673 | &ipg_clk, | ||
1674 | &ipg_perclk, | ||
1675 | &ckil_clk, | ||
1676 | &pll4_audio, | ||
1677 | NULL | ||
1678 | }, | ||
1679 | }; | ||
1680 | |||
1681 | static struct multiplexer *multiplexers[] = { | ||
1682 | &axi_mux, | ||
1683 | &periph_mux, | ||
1684 | &periph_pre_mux, | ||
1685 | &periph_clk2_mux, | ||
1686 | &periph2_mux, | ||
1687 | &periph2_pre_mux, | ||
1688 | &periph2_clk2_mux, | ||
1689 | &gpu2d_axi_mux, | ||
1690 | &gpu3d_axi_mux, | ||
1691 | &gpu3d_core_mux, | ||
1692 | &gpu3d_shader_mux, | ||
1693 | &pcie_axi_mux, | ||
1694 | &vdo_axi_mux, | ||
1695 | &vpu_axi_mux, | ||
1696 | &gpu2d_core_mux, | ||
1697 | &ssi1_mux, | ||
1698 | &ssi2_mux, | ||
1699 | &ssi3_mux, | ||
1700 | &usdhc1_mux, | ||
1701 | &usdhc2_mux, | ||
1702 | &usdhc3_mux, | ||
1703 | &usdhc4_mux, | ||
1704 | &emi_mux, | ||
1705 | &emi_slow_mux, | ||
1706 | &esai_mux, | ||
1707 | &ldb_di0_mux, | ||
1708 | &ldb_di1_mux, | ||
1709 | &enfc_mux, | ||
1710 | &spdif_mux, | ||
1711 | &asrc_serial_mux, | ||
1712 | &hsi_tx_mux, | ||
1713 | &ipu1_di0_pre_mux, | ||
1714 | &ipu1_di0_mux, | ||
1715 | &ipu1_di1_pre_mux, | ||
1716 | &ipu1_di1_mux, | ||
1717 | &ipu2_di0_pre_mux, | ||
1718 | &ipu2_di0_mux, | ||
1719 | &ipu2_di1_pre_mux, | ||
1720 | &ipu2_di1_mux, | ||
1721 | &ipu1_mux, | ||
1722 | &ipu2_mux, | ||
1723 | &cko1_mux, | ||
1724 | }; | ||
1725 | |||
1726 | static int _clk_set_parent(struct clk *clk, struct clk *parent) | ||
1727 | { | ||
1728 | struct multiplexer *m; | ||
1729 | int i, num; | ||
1730 | u32 val; | ||
1731 | |||
1732 | num = ARRAY_SIZE(multiplexers); | ||
1733 | for (i = 0; i < num; i++) | ||
1734 | if (multiplexers[i]->clk == clk) { | ||
1735 | m = multiplexers[i]; | ||
1736 | break; | ||
1737 | } | ||
1738 | if (i == num) | ||
1739 | return -EINVAL; | ||
1740 | |||
1741 | i = 0; | ||
1742 | while (m->parents[i]) { | ||
1743 | if (parent == m->parents[i]) | ||
1744 | break; | ||
1745 | i++; | ||
1746 | } | ||
1747 | if (!m->parents[i] || m->parents[i] == &dummy_clk) | ||
1748 | return -EINVAL; | ||
1749 | |||
1750 | val = readl_relaxed(m->reg); | ||
1751 | val &= ~m->bm; | ||
1752 | val |= i << m->bp; | ||
1753 | writel_relaxed(val, m->reg); | ||
1754 | |||
1755 | if (clk == &periph_clk) | ||
1756 | return clk_busy_wait(clk); | ||
1757 | |||
1758 | return 0; | ||
1759 | } | ||
1760 | |||
1761 | #define DEF_NG_CLK(name, p) \ | ||
1762 | static struct clk name = { \ | ||
1763 | .get_rate = _clk_get_rate, \ | ||
1764 | .set_rate = _clk_set_rate, \ | ||
1765 | .round_rate = _clk_round_rate, \ | ||
1766 | .set_parent = _clk_set_parent, \ | ||
1767 | .parent = p, \ | ||
1768 | } | ||
1769 | |||
1770 | DEF_NG_CLK(periph_clk2_clk, &osc_clk); | ||
1771 | DEF_NG_CLK(periph_pre_clk, &pll2_bus); | ||
1772 | DEF_NG_CLK(periph_clk, &periph_pre_clk); | ||
1773 | DEF_NG_CLK(periph2_clk2_clk, &osc_clk); | ||
1774 | DEF_NG_CLK(periph2_pre_clk, &pll2_bus); | ||
1775 | DEF_NG_CLK(periph2_clk, &periph2_pre_clk); | ||
1776 | DEF_NG_CLK(axi_clk, &periph_clk); | ||
1777 | DEF_NG_CLK(emi_clk, &axi_clk); | ||
1778 | DEF_NG_CLK(arm_clk, &pll1_sw_clk); | ||
1779 | DEF_NG_CLK(ahb_clk, &periph_clk); | ||
1780 | DEF_NG_CLK(ipg_clk, &ahb_clk); | ||
1781 | DEF_NG_CLK(ipg_perclk, &ipg_clk); | ||
1782 | DEF_NG_CLK(ipu1_di0_pre_clk, &pll3_pfd_540m); | ||
1783 | DEF_NG_CLK(ipu1_di1_pre_clk, &pll3_pfd_540m); | ||
1784 | DEF_NG_CLK(ipu2_di0_pre_clk, &pll3_pfd_540m); | ||
1785 | DEF_NG_CLK(ipu2_di1_pre_clk, &pll3_pfd_540m); | ||
1786 | DEF_NG_CLK(asrc_serial_clk, &pll3_usb_otg); | ||
1787 | |||
1788 | #define DEF_CLK(name, er, es, p, s) \ | ||
1789 | static struct clk name = { \ | ||
1790 | .enable_reg = er, \ | ||
1791 | .enable_shift = es, \ | ||
1792 | .enable = _clk_enable, \ | ||
1793 | .disable = _clk_disable, \ | ||
1794 | .get_rate = _clk_get_rate, \ | ||
1795 | .set_rate = _clk_set_rate, \ | ||
1796 | .round_rate = _clk_round_rate, \ | ||
1797 | .set_parent = _clk_set_parent, \ | ||
1798 | .parent = p, \ | ||
1799 | .secondary = s, \ | ||
1800 | } | ||
1801 | |||
1802 | #define DEF_CLK_1B(name, er, es, p, s) \ | ||
1803 | static struct clk name = { \ | ||
1804 | .enable_reg = er, \ | ||
1805 | .enable_shift = es, \ | ||
1806 | .enable = _clk_enable_1b, \ | ||
1807 | .disable = _clk_disable_1b, \ | ||
1808 | .get_rate = _clk_get_rate, \ | ||
1809 | .set_rate = _clk_set_rate, \ | ||
1810 | .round_rate = _clk_round_rate, \ | ||
1811 | .set_parent = _clk_set_parent, \ | ||
1812 | .parent = p, \ | ||
1813 | .secondary = s, \ | ||
1814 | } | ||
1815 | |||
1816 | DEF_CLK(aips_tz1_clk, CCGR0, CG0, &ahb_clk, NULL); | ||
1817 | DEF_CLK(aips_tz2_clk, CCGR0, CG1, &ahb_clk, NULL); | ||
1818 | DEF_CLK(apbh_dma_clk, CCGR0, CG2, &ahb_clk, NULL); | ||
1819 | DEF_CLK(asrc_clk, CCGR0, CG3, &pll4_audio, NULL); | ||
1820 | DEF_CLK(can1_serial_clk, CCGR0, CG8, &pll3_usb_otg, NULL); | ||
1821 | DEF_CLK(can1_clk, CCGR0, CG7, &pll3_usb_otg, &can1_serial_clk); | ||
1822 | DEF_CLK(can2_serial_clk, CCGR0, CG10, &pll3_usb_otg, NULL); | ||
1823 | DEF_CLK(can2_clk, CCGR0, CG9, &pll3_usb_otg, &can2_serial_clk); | ||
1824 | DEF_CLK(ecspi1_clk, CCGR1, CG0, &pll3_60m, NULL); | ||
1825 | DEF_CLK(ecspi2_clk, CCGR1, CG1, &pll3_60m, NULL); | ||
1826 | DEF_CLK(ecspi3_clk, CCGR1, CG2, &pll3_60m, NULL); | ||
1827 | DEF_CLK(ecspi4_clk, CCGR1, CG3, &pll3_60m, NULL); | ||
1828 | DEF_CLK(ecspi5_clk, CCGR1, CG4, &pll3_60m, NULL); | ||
1829 | DEF_CLK(enet_clk, CCGR1, CG5, &ipg_clk, NULL); | ||
1830 | DEF_CLK(esai_clk, CCGR1, CG8, &pll3_usb_otg, NULL); | ||
1831 | DEF_CLK(gpt_serial_clk, CCGR1, CG11, &ipg_perclk, NULL); | ||
1832 | DEF_CLK(gpt_clk, CCGR1, CG10, &ipg_perclk, &gpt_serial_clk); | ||
1833 | DEF_CLK(gpu2d_core_clk, CCGR1, CG12, &pll2_pfd_352m, &gpu2d_axi_clk); | ||
1834 | DEF_CLK(gpu3d_core_clk, CCGR1, CG13, &pll2_pfd_594m, &gpu3d_axi_clk); | ||
1835 | DEF_CLK(gpu3d_shader_clk, CCGR1, CG13, &pll3_pfd_720m, &gpu3d_axi_clk); | ||
1836 | DEF_CLK(hdmi_iahb_clk, CCGR2, CG0, &ahb_clk, NULL); | ||
1837 | DEF_CLK(hdmi_isfr_clk, CCGR2, CG2, &pll3_pfd_540m, &hdmi_iahb_clk); | ||
1838 | DEF_CLK(i2c1_clk, CCGR2, CG3, &ipg_perclk, NULL); | ||
1839 | DEF_CLK(i2c2_clk, CCGR2, CG4, &ipg_perclk, NULL); | ||
1840 | DEF_CLK(i2c3_clk, CCGR2, CG5, &ipg_perclk, NULL); | ||
1841 | DEF_CLK(iim_clk, CCGR2, CG6, &ipg_clk, NULL); | ||
1842 | DEF_CLK(enfc_clk, CCGR2, CG7, &pll2_pfd_352m, NULL); | ||
1843 | DEF_CLK(ipu1_clk, CCGR3, CG0, &mmdc_ch0_axi_clk, NULL); | ||
1844 | DEF_CLK(ipu1_di0_clk, CCGR3, CG1, &ipu1_di0_pre_clk, NULL); | ||
1845 | DEF_CLK(ipu1_di1_clk, CCGR3, CG2, &ipu1_di1_pre_clk, NULL); | ||
1846 | DEF_CLK(ipu2_clk, CCGR3, CG3, &mmdc_ch0_axi_clk, NULL); | ||
1847 | DEF_CLK(ipu2_di0_clk, CCGR3, CG4, &ipu2_di0_pre_clk, NULL); | ||
1848 | DEF_CLK(ipu2_di1_clk, CCGR3, CG5, &ipu2_di1_pre_clk, NULL); | ||
1849 | DEF_CLK(ldb_di0_clk, CCGR3, CG6, &pll3_pfd_540m, NULL); | ||
1850 | DEF_CLK(ldb_di1_clk, CCGR3, CG7, &pll3_pfd_540m, NULL); | ||
1851 | DEF_CLK(hsi_tx_clk, CCGR3, CG8, &pll2_pfd_400m, NULL); | ||
1852 | DEF_CLK(mlb_clk, CCGR3, CG9, &pll6_mlb, NULL); | ||
1853 | DEF_CLK(mmdc_ch0_ipg_clk, CCGR3, CG12, &ipg_clk, NULL); | ||
1854 | DEF_CLK(mmdc_ch0_axi_clk, CCGR3, CG10, &periph_clk, &mmdc_ch0_ipg_clk); | ||
1855 | DEF_CLK(mmdc_ch1_ipg_clk, CCGR3, CG13, &ipg_clk, NULL); | ||
1856 | DEF_CLK(mmdc_ch1_axi_clk, CCGR3, CG11, &periph2_clk, &mmdc_ch1_ipg_clk); | ||
1857 | DEF_CLK(openvg_axi_clk, CCGR3, CG13, &axi_clk, NULL); | ||
1858 | DEF_CLK(pwm1_clk, CCGR4, CG8, &ipg_perclk, NULL); | ||
1859 | DEF_CLK(pwm2_clk, CCGR4, CG9, &ipg_perclk, NULL); | ||
1860 | DEF_CLK(pwm3_clk, CCGR4, CG10, &ipg_perclk, NULL); | ||
1861 | DEF_CLK(pwm4_clk, CCGR4, CG11, &ipg_perclk, NULL); | ||
1862 | DEF_CLK(gpmi_bch_apb_clk, CCGR4, CG12, &usdhc3_clk, NULL); | ||
1863 | DEF_CLK(gpmi_bch_clk, CCGR4, CG13, &usdhc4_clk, &gpmi_bch_apb_clk); | ||
1864 | DEF_CLK(gpmi_apb_clk, CCGR4, CG15, &usdhc3_clk, &gpmi_bch_clk); | ||
1865 | DEF_CLK(gpmi_io_clk, CCGR4, CG14, &enfc_clk, &gpmi_apb_clk); | ||
1866 | DEF_CLK(sdma_clk, CCGR5, CG3, &ahb_clk, NULL); | ||
1867 | DEF_CLK(spba_clk, CCGR5, CG6, &ipg_clk, NULL); | ||
1868 | DEF_CLK(spdif_clk, CCGR5, CG7, &pll3_usb_otg, &spba_clk); | ||
1869 | DEF_CLK(ssi1_clk, CCGR5, CG9, &pll3_pfd_508m, NULL); | ||
1870 | DEF_CLK(ssi2_clk, CCGR5, CG10, &pll3_pfd_508m, NULL); | ||
1871 | DEF_CLK(ssi3_clk, CCGR5, CG11, &pll3_pfd_508m, NULL); | ||
1872 | DEF_CLK(uart_serial_clk, CCGR5, CG13, &pll3_usb_otg, NULL); | ||
1873 | DEF_CLK(uart_clk, CCGR5, CG12, &pll3_80m, &uart_serial_clk); | ||
1874 | DEF_CLK(usboh3_clk, CCGR6, CG0, &ipg_clk, NULL); | ||
1875 | DEF_CLK(usdhc1_clk, CCGR6, CG1, &pll2_pfd_400m, NULL); | ||
1876 | DEF_CLK(usdhc2_clk, CCGR6, CG2, &pll2_pfd_400m, NULL); | ||
1877 | DEF_CLK(usdhc3_clk, CCGR6, CG3, &pll2_pfd_400m, NULL); | ||
1878 | DEF_CLK(usdhc4_clk, CCGR6, CG4, &pll2_pfd_400m, NULL); | ||
1879 | DEF_CLK(emi_slow_clk, CCGR6, CG5, &axi_clk, NULL); | ||
1880 | DEF_CLK(vdo_axi_clk, CCGR6, CG6, &axi_clk, NULL); | ||
1881 | DEF_CLK(vpu_clk, CCGR6, CG7, &axi_clk, NULL); | ||
1882 | DEF_CLK_1B(cko1_clk, CCOSR, BP_CCOSR_CKO1_EN, &pll2_bus, NULL); | ||
1883 | |||
1884 | static int pcie_clk_enable(struct clk *clk) | ||
1885 | { | ||
1886 | u32 val; | ||
1887 | |||
1888 | val = readl_relaxed(PLL8_ENET); | ||
1889 | val |= BM_PLL_ENET_EN_PCIE; | ||
1890 | writel_relaxed(val, PLL8_ENET); | ||
1891 | |||
1892 | return _clk_enable(clk); | ||
1893 | } | ||
1894 | |||
1895 | static void pcie_clk_disable(struct clk *clk) | ||
1896 | { | ||
1897 | u32 val; | ||
1898 | |||
1899 | _clk_disable(clk); | ||
1900 | |||
1901 | val = readl_relaxed(PLL8_ENET); | ||
1902 | val &= BM_PLL_ENET_EN_PCIE; | ||
1903 | writel_relaxed(val, PLL8_ENET); | ||
1904 | } | ||
1905 | |||
1906 | static struct clk pcie_clk = { | ||
1907 | .enable_reg = CCGR4, | ||
1908 | .enable_shift = CG0, | ||
1909 | .enable = pcie_clk_enable, | ||
1910 | .disable = pcie_clk_disable, | ||
1911 | .set_parent = _clk_set_parent, | ||
1912 | .parent = &axi_clk, | ||
1913 | .secondary = &pll8_enet, | ||
1914 | }; | ||
1915 | |||
1916 | static int sata_clk_enable(struct clk *clk) | ||
1917 | { | ||
1918 | u32 val; | ||
1919 | |||
1920 | val = readl_relaxed(PLL8_ENET); | ||
1921 | val |= BM_PLL_ENET_EN_SATA; | ||
1922 | writel_relaxed(val, PLL8_ENET); | ||
1923 | |||
1924 | return _clk_enable(clk); | ||
1925 | } | ||
1926 | |||
1927 | static void sata_clk_disable(struct clk *clk) | ||
1928 | { | ||
1929 | u32 val; | ||
1930 | |||
1931 | _clk_disable(clk); | ||
1932 | |||
1933 | val = readl_relaxed(PLL8_ENET); | ||
1934 | val &= BM_PLL_ENET_EN_SATA; | ||
1935 | writel_relaxed(val, PLL8_ENET); | ||
1936 | } | ||
1937 | |||
1938 | static struct clk sata_clk = { | ||
1939 | .enable_reg = CCGR5, | ||
1940 | .enable_shift = CG2, | ||
1941 | .enable = sata_clk_enable, | ||
1942 | .disable = sata_clk_disable, | ||
1943 | .parent = &ipg_clk, | ||
1944 | .secondary = &pll8_enet, | ||
1945 | }; | ||
1946 | |||
1947 | #define _REGISTER_CLOCK(d, n, c) \ | ||
1948 | { \ | ||
1949 | .dev_id = d, \ | ||
1950 | .con_id = n, \ | ||
1951 | .clk = &c, \ | ||
1952 | } | ||
1953 | |||
1954 | static struct clk_lookup lookups[] = { | ||
1955 | _REGISTER_CLOCK("2020000.uart", NULL, uart_clk), | ||
1956 | _REGISTER_CLOCK("21e8000.uart", NULL, uart_clk), | ||
1957 | _REGISTER_CLOCK("21ec000.uart", NULL, uart_clk), | ||
1958 | _REGISTER_CLOCK("21f0000.uart", NULL, uart_clk), | ||
1959 | _REGISTER_CLOCK("21f4000.uart", NULL, uart_clk), | ||
1960 | _REGISTER_CLOCK("2188000.enet", NULL, enet_clk), | ||
1961 | _REGISTER_CLOCK("2190000.usdhc", NULL, usdhc1_clk), | ||
1962 | _REGISTER_CLOCK("2194000.usdhc", NULL, usdhc2_clk), | ||
1963 | _REGISTER_CLOCK("2198000.usdhc", NULL, usdhc3_clk), | ||
1964 | _REGISTER_CLOCK("219c000.usdhc", NULL, usdhc4_clk), | ||
1965 | _REGISTER_CLOCK("21a0000.i2c", NULL, i2c1_clk), | ||
1966 | _REGISTER_CLOCK("21a4000.i2c", NULL, i2c2_clk), | ||
1967 | _REGISTER_CLOCK("21a8000.i2c", NULL, i2c3_clk), | ||
1968 | _REGISTER_CLOCK("2008000.ecspi", NULL, ecspi1_clk), | ||
1969 | _REGISTER_CLOCK("200c000.ecspi", NULL, ecspi2_clk), | ||
1970 | _REGISTER_CLOCK("2010000.ecspi", NULL, ecspi3_clk), | ||
1971 | _REGISTER_CLOCK("2014000.ecspi", NULL, ecspi4_clk), | ||
1972 | _REGISTER_CLOCK("2018000.ecspi", NULL, ecspi5_clk), | ||
1973 | _REGISTER_CLOCK("20ec000.sdma", NULL, sdma_clk), | ||
1974 | _REGISTER_CLOCK("20bc000.wdog", NULL, dummy_clk), | ||
1975 | _REGISTER_CLOCK("20c0000.wdog", NULL, dummy_clk), | ||
1976 | _REGISTER_CLOCK("smp_twd", NULL, twd_clk), | ||
1977 | _REGISTER_CLOCK(NULL, "ckih", ckih_clk), | ||
1978 | _REGISTER_CLOCK(NULL, "ckil_clk", ckil_clk), | ||
1979 | _REGISTER_CLOCK(NULL, "aips_tz1_clk", aips_tz1_clk), | ||
1980 | _REGISTER_CLOCK(NULL, "aips_tz2_clk", aips_tz2_clk), | ||
1981 | _REGISTER_CLOCK(NULL, "asrc_clk", asrc_clk), | ||
1982 | _REGISTER_CLOCK(NULL, "can2_clk", can2_clk), | ||
1983 | _REGISTER_CLOCK(NULL, "hdmi_isfr_clk", hdmi_isfr_clk), | ||
1984 | _REGISTER_CLOCK(NULL, "iim_clk", iim_clk), | ||
1985 | _REGISTER_CLOCK(NULL, "mlb_clk", mlb_clk), | ||
1986 | _REGISTER_CLOCK(NULL, "openvg_axi_clk", openvg_axi_clk), | ||
1987 | _REGISTER_CLOCK(NULL, "pwm1_clk", pwm1_clk), | ||
1988 | _REGISTER_CLOCK(NULL, "pwm2_clk", pwm2_clk), | ||
1989 | _REGISTER_CLOCK(NULL, "pwm3_clk", pwm3_clk), | ||
1990 | _REGISTER_CLOCK(NULL, "pwm4_clk", pwm4_clk), | ||
1991 | _REGISTER_CLOCK(NULL, "gpmi_io_clk", gpmi_io_clk), | ||
1992 | _REGISTER_CLOCK(NULL, "usboh3_clk", usboh3_clk), | ||
1993 | _REGISTER_CLOCK(NULL, "sata_clk", sata_clk), | ||
1994 | _REGISTER_CLOCK(NULL, "cko1_clk", cko1_clk), | ||
1995 | }; | ||
1996 | |||
1997 | int imx6q_set_lpm(enum mxc_cpu_pwr_mode mode) | ||
1998 | { | ||
1999 | u32 val = readl_relaxed(CLPCR); | ||
2000 | |||
2001 | val &= ~BM_CLPCR_LPM; | ||
2002 | switch (mode) { | ||
2003 | case WAIT_CLOCKED: | ||
2004 | break; | ||
2005 | case WAIT_UNCLOCKED: | ||
2006 | val |= 0x1 << BP_CLPCR_LPM; | ||
2007 | break; | ||
2008 | case STOP_POWER_ON: | ||
2009 | val |= 0x2 << BP_CLPCR_LPM; | ||
2010 | break; | ||
2011 | case WAIT_UNCLOCKED_POWER_OFF: | ||
2012 | val |= 0x1 << BP_CLPCR_LPM; | ||
2013 | val &= ~BM_CLPCR_VSTBY; | ||
2014 | val &= ~BM_CLPCR_SBYOS; | ||
2015 | break; | ||
2016 | case STOP_POWER_OFF: | ||
2017 | val |= 0x2 << BP_CLPCR_LPM; | ||
2018 | val |= 0x3 << BP_CLPCR_STBY_COUNT; | ||
2019 | val |= BM_CLPCR_VSTBY; | ||
2020 | val |= BM_CLPCR_SBYOS; | ||
2021 | break; | ||
2022 | default: | ||
2023 | return -EINVAL; | ||
2024 | } | ||
2025 | writel_relaxed(val, CLPCR); | ||
2026 | |||
2027 | return 0; | ||
2028 | } | ||
2029 | |||
2030 | static struct map_desc imx6q_clock_desc[] = { | ||
2031 | imx_map_entry(MX6Q, CCM, MT_DEVICE), | ||
2032 | imx_map_entry(MX6Q, ANATOP, MT_DEVICE), | ||
2033 | }; | ||
2034 | |||
2035 | void __init imx6q_clock_map_io(void) | ||
2036 | { | ||
2037 | iotable_init(imx6q_clock_desc, ARRAY_SIZE(imx6q_clock_desc)); | ||
2038 | } | ||
2039 | |||
2040 | int __init mx6q_clocks_init(void) | ||
2041 | { | ||
2042 | struct device_node *np; | ||
2043 | void __iomem *base; | ||
2044 | int i, irq; | ||
2045 | |||
2046 | /* retrieve the freqency of fixed clocks from device tree */ | ||
2047 | for_each_compatible_node(np, NULL, "fixed-clock") { | ||
2048 | u32 rate; | ||
2049 | if (of_property_read_u32(np, "clock-frequency", &rate)) | ||
2050 | continue; | ||
2051 | |||
2052 | if (of_device_is_compatible(np, "fsl,imx-ckil")) | ||
2053 | external_low_reference = rate; | ||
2054 | else if (of_device_is_compatible(np, "fsl,imx-ckih1")) | ||
2055 | external_high_reference = rate; | ||
2056 | else if (of_device_is_compatible(np, "fsl,imx-osc")) | ||
2057 | oscillator_reference = rate; | ||
2058 | } | ||
2059 | |||
2060 | for (i = 0; i < ARRAY_SIZE(lookups); i++) | ||
2061 | clkdev_add(&lookups[i]); | ||
2062 | |||
2063 | /* only keep necessary clocks on */ | ||
2064 | writel_relaxed(0x3 << CG0 | 0x3 << CG1 | 0x3 << CG2, CCGR0); | ||
2065 | writel_relaxed(0x3 << CG8 | 0x3 << CG9 | 0x3 << CG10, CCGR2); | ||
2066 | writel_relaxed(0x3 << CG10 | 0x3 << CG12, CCGR3); | ||
2067 | writel_relaxed(0x3 << CG4 | 0x3 << CG6 | 0x3 << CG7, CCGR4); | ||
2068 | writel_relaxed(0x3 << CG0, CCGR5); | ||
2069 | writel_relaxed(0, CCGR6); | ||
2070 | writel_relaxed(0, CCGR7); | ||
2071 | |||
2072 | clk_enable(&uart_clk); | ||
2073 | clk_enable(&mmdc_ch0_axi_clk); | ||
2074 | |||
2075 | clk_set_rate(&pll4_audio, FREQ_650M); | ||
2076 | clk_set_rate(&pll5_video, FREQ_650M); | ||
2077 | clk_set_parent(&ipu1_di0_clk, &ipu1_di0_pre_clk); | ||
2078 | clk_set_parent(&ipu1_di0_pre_clk, &pll5_video); | ||
2079 | clk_set_parent(&gpu3d_shader_clk, &pll2_pfd_594m); | ||
2080 | clk_set_rate(&gpu3d_shader_clk, FREQ_594M); | ||
2081 | clk_set_parent(&gpu3d_core_clk, &mmdc_ch0_axi_clk); | ||
2082 | clk_set_rate(&gpu3d_core_clk, FREQ_528M); | ||
2083 | clk_set_parent(&asrc_serial_clk, &pll3_usb_otg); | ||
2084 | clk_set_rate(&asrc_serial_clk, 1500000); | ||
2085 | clk_set_rate(&enfc_clk, 11000000); | ||
2086 | |||
2087 | /* | ||
2088 | * Before pinctrl API is available, we have to rely on the pad | ||
2089 | * configuration set up by bootloader. For usdhc example here, | ||
2090 | * u-boot sets up the pads for 49.5 MHz case, and we have to lower | ||
2091 | * the usdhc clock from 198 to 49.5 MHz to match the pad configuration. | ||
2092 | * | ||
2093 | * FIXME: This is should be removed after pinctrl API is available. | ||
2094 | * At that time, usdhc driver can call pinctrl API to change pad | ||
2095 | * configuration dynamically per different usdhc clock settings. | ||
2096 | */ | ||
2097 | clk_set_rate(&usdhc1_clk, 49500000); | ||
2098 | clk_set_rate(&usdhc2_clk, 49500000); | ||
2099 | clk_set_rate(&usdhc3_clk, 49500000); | ||
2100 | clk_set_rate(&usdhc4_clk, 49500000); | ||
2101 | |||
2102 | clk_set_parent(&cko1_clk, &ahb_clk); | ||
2103 | |||
2104 | np = of_find_compatible_node(NULL, NULL, "fsl,imx6q-gpt"); | ||
2105 | base = of_iomap(np, 0); | ||
2106 | WARN_ON(!base); | ||
2107 | irq = irq_of_parse_and_map(np, 0); | ||
2108 | mxc_timer_init(&gpt_clk, base, irq); | ||
2109 | |||
2110 | return 0; | ||
2111 | } | ||
diff --git a/arch/arm/mach-imx/clock-mx51-mx53.c b/arch/arm/mach-imx/clock-mx51-mx53.c deleted file mode 100644 index 08470504a088..000000000000 --- a/arch/arm/mach-imx/clock-mx51-mx53.c +++ /dev/null | |||
@@ -1,1675 +0,0 @@ | |||
1 | /* | ||
2 | * Copyright 2008-2010 Freescale Semiconductor, Inc. All Rights Reserved. | ||
3 | * Copyright (C) 2009-2010 Amit Kucheria <amit.kucheria@canonical.com> | ||
4 | * | ||
5 | * The code contained herein is licensed under the GNU General Public | ||
6 | * License. You may obtain a copy of the GNU General Public License | ||
7 | * Version 2 or later at the following locations: | ||
8 | * | ||
9 | * http://www.opensource.org/licenses/gpl-license.html | ||
10 | * http://www.gnu.org/copyleft/gpl.html | ||
11 | */ | ||
12 | |||
13 | #include <linux/mm.h> | ||
14 | #include <linux/delay.h> | ||
15 | #include <linux/clk.h> | ||
16 | #include <linux/io.h> | ||
17 | #include <linux/clkdev.h> | ||
18 | #include <linux/of.h> | ||
19 | |||
20 | #include <asm/div64.h> | ||
21 | |||
22 | #include <mach/hardware.h> | ||
23 | #include <mach/common.h> | ||
24 | #include <mach/clock.h> | ||
25 | |||
26 | #include "crm-regs-imx5.h" | ||
27 | |||
28 | /* External clock values passed-in by the board code */ | ||
29 | static unsigned long external_high_reference, external_low_reference; | ||
30 | static unsigned long oscillator_reference, ckih2_reference; | ||
31 | |||
32 | static struct clk osc_clk; | ||
33 | static struct clk pll1_main_clk; | ||
34 | static struct clk pll1_sw_clk; | ||
35 | static struct clk pll2_sw_clk; | ||
36 | static struct clk pll3_sw_clk; | ||
37 | static struct clk mx53_pll4_sw_clk; | ||
38 | static struct clk lp_apm_clk; | ||
39 | static struct clk periph_apm_clk; | ||
40 | static struct clk ahb_clk; | ||
41 | static struct clk ipg_clk; | ||
42 | static struct clk usboh3_clk; | ||
43 | static struct clk emi_fast_clk; | ||
44 | static struct clk ipu_clk; | ||
45 | static struct clk mipi_hsc1_clk; | ||
46 | static struct clk esdhc1_clk; | ||
47 | static struct clk esdhc2_clk; | ||
48 | static struct clk esdhc3_mx53_clk; | ||
49 | |||
50 | #define MAX_DPLL_WAIT_TRIES 1000 /* 1000 * udelay(1) = 1ms */ | ||
51 | |||
52 | /* calculate best pre and post dividers to get the required divider */ | ||
53 | static void __calc_pre_post_dividers(u32 div, u32 *pre, u32 *post, | ||
54 | u32 max_pre, u32 max_post) | ||
55 | { | ||
56 | if (div >= max_pre * max_post) { | ||
57 | *pre = max_pre; | ||
58 | *post = max_post; | ||
59 | } else if (div >= max_pre) { | ||
60 | u32 min_pre, temp_pre, old_err, err; | ||
61 | min_pre = DIV_ROUND_UP(div, max_post); | ||
62 | old_err = max_pre; | ||
63 | for (temp_pre = max_pre; temp_pre >= min_pre; temp_pre--) { | ||
64 | err = div % temp_pre; | ||
65 | if (err == 0) { | ||
66 | *pre = temp_pre; | ||
67 | break; | ||
68 | } | ||
69 | err = temp_pre - err; | ||
70 | if (err < old_err) { | ||
71 | old_err = err; | ||
72 | *pre = temp_pre; | ||
73 | } | ||
74 | } | ||
75 | *post = DIV_ROUND_UP(div, *pre); | ||
76 | } else { | ||
77 | *pre = div; | ||
78 | *post = 1; | ||
79 | } | ||
80 | } | ||
81 | |||
82 | static void _clk_ccgr_setclk(struct clk *clk, unsigned mode) | ||
83 | { | ||
84 | u32 reg = __raw_readl(clk->enable_reg); | ||
85 | |||
86 | reg &= ~(MXC_CCM_CCGRx_CG_MASK << clk->enable_shift); | ||
87 | reg |= mode << clk->enable_shift; | ||
88 | |||
89 | __raw_writel(reg, clk->enable_reg); | ||
90 | } | ||
91 | |||
92 | static int _clk_ccgr_enable(struct clk *clk) | ||
93 | { | ||
94 | _clk_ccgr_setclk(clk, MXC_CCM_CCGRx_MOD_ON); | ||
95 | return 0; | ||
96 | } | ||
97 | |||
98 | static void _clk_ccgr_disable(struct clk *clk) | ||
99 | { | ||
100 | _clk_ccgr_setclk(clk, MXC_CCM_CCGRx_MOD_OFF); | ||
101 | } | ||
102 | |||
103 | static int _clk_ccgr_enable_inrun(struct clk *clk) | ||
104 | { | ||
105 | _clk_ccgr_setclk(clk, MXC_CCM_CCGRx_MOD_IDLE); | ||
106 | return 0; | ||
107 | } | ||
108 | |||
109 | static void _clk_ccgr_disable_inwait(struct clk *clk) | ||
110 | { | ||
111 | _clk_ccgr_setclk(clk, MXC_CCM_CCGRx_MOD_IDLE); | ||
112 | } | ||
113 | |||
114 | /* | ||
115 | * For the 4-to-1 muxed input clock | ||
116 | */ | ||
117 | static inline u32 _get_mux(struct clk *parent, struct clk *m0, | ||
118 | struct clk *m1, struct clk *m2, struct clk *m3) | ||
119 | { | ||
120 | if (parent == m0) | ||
121 | return 0; | ||
122 | else if (parent == m1) | ||
123 | return 1; | ||
124 | else if (parent == m2) | ||
125 | return 2; | ||
126 | else if (parent == m3) | ||
127 | return 3; | ||
128 | else | ||
129 | BUG(); | ||
130 | |||
131 | return -EINVAL; | ||
132 | } | ||
133 | |||
134 | static inline void __iomem *_mx51_get_pll_base(struct clk *pll) | ||
135 | { | ||
136 | if (pll == &pll1_main_clk) | ||
137 | return MX51_DPLL1_BASE; | ||
138 | else if (pll == &pll2_sw_clk) | ||
139 | return MX51_DPLL2_BASE; | ||
140 | else if (pll == &pll3_sw_clk) | ||
141 | return MX51_DPLL3_BASE; | ||
142 | else | ||
143 | BUG(); | ||
144 | |||
145 | return NULL; | ||
146 | } | ||
147 | |||
148 | static inline void __iomem *_mx53_get_pll_base(struct clk *pll) | ||
149 | { | ||
150 | if (pll == &pll1_main_clk) | ||
151 | return MX53_DPLL1_BASE; | ||
152 | else if (pll == &pll2_sw_clk) | ||
153 | return MX53_DPLL2_BASE; | ||
154 | else if (pll == &pll3_sw_clk) | ||
155 | return MX53_DPLL3_BASE; | ||
156 | else if (pll == &mx53_pll4_sw_clk) | ||
157 | return MX53_DPLL4_BASE; | ||
158 | else | ||
159 | BUG(); | ||
160 | |||
161 | return NULL; | ||
162 | } | ||
163 | |||
164 | static inline void __iomem *_get_pll_base(struct clk *pll) | ||
165 | { | ||
166 | if (cpu_is_mx51()) | ||
167 | return _mx51_get_pll_base(pll); | ||
168 | else | ||
169 | return _mx53_get_pll_base(pll); | ||
170 | } | ||
171 | |||
172 | static unsigned long clk_pll_get_rate(struct clk *clk) | ||
173 | { | ||
174 | long mfi, mfn, mfd, pdf, ref_clk, mfn_abs; | ||
175 | unsigned long dp_op, dp_mfd, dp_mfn, dp_ctl, pll_hfsm, dbl; | ||
176 | void __iomem *pllbase; | ||
177 | s64 temp; | ||
178 | unsigned long parent_rate; | ||
179 | |||
180 | parent_rate = clk_get_rate(clk->parent); | ||
181 | |||
182 | pllbase = _get_pll_base(clk); | ||
183 | |||
184 | dp_ctl = __raw_readl(pllbase + MXC_PLL_DP_CTL); | ||
185 | pll_hfsm = dp_ctl & MXC_PLL_DP_CTL_HFSM; | ||
186 | dbl = dp_ctl & MXC_PLL_DP_CTL_DPDCK0_2_EN; | ||
187 | |||
188 | if (pll_hfsm == 0) { | ||
189 | dp_op = __raw_readl(pllbase + MXC_PLL_DP_OP); | ||
190 | dp_mfd = __raw_readl(pllbase + MXC_PLL_DP_MFD); | ||
191 | dp_mfn = __raw_readl(pllbase + MXC_PLL_DP_MFN); | ||
192 | } else { | ||
193 | dp_op = __raw_readl(pllbase + MXC_PLL_DP_HFS_OP); | ||
194 | dp_mfd = __raw_readl(pllbase + MXC_PLL_DP_HFS_MFD); | ||
195 | dp_mfn = __raw_readl(pllbase + MXC_PLL_DP_HFS_MFN); | ||
196 | } | ||
197 | pdf = dp_op & MXC_PLL_DP_OP_PDF_MASK; | ||
198 | mfi = (dp_op & MXC_PLL_DP_OP_MFI_MASK) >> MXC_PLL_DP_OP_MFI_OFFSET; | ||
199 | mfi = (mfi <= 5) ? 5 : mfi; | ||
200 | mfd = dp_mfd & MXC_PLL_DP_MFD_MASK; | ||
201 | mfn = mfn_abs = dp_mfn & MXC_PLL_DP_MFN_MASK; | ||
202 | /* Sign extend to 32-bits */ | ||
203 | if (mfn >= 0x04000000) { | ||
204 | mfn |= 0xFC000000; | ||
205 | mfn_abs = -mfn; | ||
206 | } | ||
207 | |||
208 | ref_clk = 2 * parent_rate; | ||
209 | if (dbl != 0) | ||
210 | ref_clk *= 2; | ||
211 | |||
212 | ref_clk /= (pdf + 1); | ||
213 | temp = (u64) ref_clk * mfn_abs; | ||
214 | do_div(temp, mfd + 1); | ||
215 | if (mfn < 0) | ||
216 | temp = -temp; | ||
217 | temp = (ref_clk * mfi) + temp; | ||
218 | |||
219 | return temp; | ||
220 | } | ||
221 | |||
222 | static int _clk_pll_set_rate(struct clk *clk, unsigned long rate) | ||
223 | { | ||
224 | u32 reg; | ||
225 | void __iomem *pllbase; | ||
226 | |||
227 | long mfi, pdf, mfn, mfd = 999999; | ||
228 | s64 temp64; | ||
229 | unsigned long quad_parent_rate; | ||
230 | unsigned long pll_hfsm, dp_ctl; | ||
231 | unsigned long parent_rate; | ||
232 | |||
233 | parent_rate = clk_get_rate(clk->parent); | ||
234 | |||
235 | pllbase = _get_pll_base(clk); | ||
236 | |||
237 | quad_parent_rate = 4 * parent_rate; | ||
238 | pdf = mfi = -1; | ||
239 | while (++pdf < 16 && mfi < 5) | ||
240 | mfi = rate * (pdf+1) / quad_parent_rate; | ||
241 | if (mfi > 15) | ||
242 | return -EINVAL; | ||
243 | pdf--; | ||
244 | |||
245 | temp64 = rate * (pdf+1) - quad_parent_rate * mfi; | ||
246 | do_div(temp64, quad_parent_rate/1000000); | ||
247 | mfn = (long)temp64; | ||
248 | |||
249 | dp_ctl = __raw_readl(pllbase + MXC_PLL_DP_CTL); | ||
250 | /* use dpdck0_2 */ | ||
251 | __raw_writel(dp_ctl | 0x1000L, pllbase + MXC_PLL_DP_CTL); | ||
252 | pll_hfsm = dp_ctl & MXC_PLL_DP_CTL_HFSM; | ||
253 | if (pll_hfsm == 0) { | ||
254 | reg = mfi << 4 | pdf; | ||
255 | __raw_writel(reg, pllbase + MXC_PLL_DP_OP); | ||
256 | __raw_writel(mfd, pllbase + MXC_PLL_DP_MFD); | ||
257 | __raw_writel(mfn, pllbase + MXC_PLL_DP_MFN); | ||
258 | } else { | ||
259 | reg = mfi << 4 | pdf; | ||
260 | __raw_writel(reg, pllbase + MXC_PLL_DP_HFS_OP); | ||
261 | __raw_writel(mfd, pllbase + MXC_PLL_DP_HFS_MFD); | ||
262 | __raw_writel(mfn, pllbase + MXC_PLL_DP_HFS_MFN); | ||
263 | } | ||
264 | |||
265 | return 0; | ||
266 | } | ||
267 | |||
268 | static int _clk_pll_enable(struct clk *clk) | ||
269 | { | ||
270 | u32 reg; | ||
271 | void __iomem *pllbase; | ||
272 | int i = 0; | ||
273 | |||
274 | pllbase = _get_pll_base(clk); | ||
275 | reg = __raw_readl(pllbase + MXC_PLL_DP_CTL); | ||
276 | if (reg & MXC_PLL_DP_CTL_UPEN) | ||
277 | return 0; | ||
278 | |||
279 | reg |= MXC_PLL_DP_CTL_UPEN; | ||
280 | __raw_writel(reg, pllbase + MXC_PLL_DP_CTL); | ||
281 | |||
282 | /* Wait for lock */ | ||
283 | do { | ||
284 | reg = __raw_readl(pllbase + MXC_PLL_DP_CTL); | ||
285 | if (reg & MXC_PLL_DP_CTL_LRF) | ||
286 | break; | ||
287 | |||
288 | udelay(1); | ||
289 | } while (++i < MAX_DPLL_WAIT_TRIES); | ||
290 | |||
291 | if (i == MAX_DPLL_WAIT_TRIES) { | ||
292 | pr_err("MX5: pll locking failed\n"); | ||
293 | return -EINVAL; | ||
294 | } | ||
295 | |||
296 | return 0; | ||
297 | } | ||
298 | |||
299 | static void _clk_pll_disable(struct clk *clk) | ||
300 | { | ||
301 | u32 reg; | ||
302 | void __iomem *pllbase; | ||
303 | |||
304 | pllbase = _get_pll_base(clk); | ||
305 | reg = __raw_readl(pllbase + MXC_PLL_DP_CTL) & ~MXC_PLL_DP_CTL_UPEN; | ||
306 | __raw_writel(reg, pllbase + MXC_PLL_DP_CTL); | ||
307 | } | ||
308 | |||
309 | static int _clk_pll1_sw_set_parent(struct clk *clk, struct clk *parent) | ||
310 | { | ||
311 | u32 reg, step; | ||
312 | |||
313 | reg = __raw_readl(MXC_CCM_CCSR); | ||
314 | |||
315 | /* When switching from pll_main_clk to a bypass clock, first select a | ||
316 | * multiplexed clock in 'step_sel', then shift the glitchless mux | ||
317 | * 'pll1_sw_clk_sel'. | ||
318 | * | ||
319 | * When switching back, do it in reverse order | ||
320 | */ | ||
321 | if (parent == &pll1_main_clk) { | ||
322 | /* Switch to pll1_main_clk */ | ||
323 | reg &= ~MXC_CCM_CCSR_PLL1_SW_CLK_SEL; | ||
324 | __raw_writel(reg, MXC_CCM_CCSR); | ||
325 | /* step_clk mux switched to lp_apm, to save power. */ | ||
326 | reg = __raw_readl(MXC_CCM_CCSR); | ||
327 | reg &= ~MXC_CCM_CCSR_STEP_SEL_MASK; | ||
328 | reg |= (MXC_CCM_CCSR_STEP_SEL_LP_APM << | ||
329 | MXC_CCM_CCSR_STEP_SEL_OFFSET); | ||
330 | } else { | ||
331 | if (parent == &lp_apm_clk) { | ||
332 | step = MXC_CCM_CCSR_STEP_SEL_LP_APM; | ||
333 | } else if (parent == &pll2_sw_clk) { | ||
334 | step = MXC_CCM_CCSR_STEP_SEL_PLL2_DIVIDED; | ||
335 | } else if (parent == &pll3_sw_clk) { | ||
336 | step = MXC_CCM_CCSR_STEP_SEL_PLL3_DIVIDED; | ||
337 | } else | ||
338 | return -EINVAL; | ||
339 | |||
340 | reg &= ~MXC_CCM_CCSR_STEP_SEL_MASK; | ||
341 | reg |= (step << MXC_CCM_CCSR_STEP_SEL_OFFSET); | ||
342 | |||
343 | __raw_writel(reg, MXC_CCM_CCSR); | ||
344 | /* Switch to step_clk */ | ||
345 | reg = __raw_readl(MXC_CCM_CCSR); | ||
346 | reg |= MXC_CCM_CCSR_PLL1_SW_CLK_SEL; | ||
347 | } | ||
348 | __raw_writel(reg, MXC_CCM_CCSR); | ||
349 | return 0; | ||
350 | } | ||
351 | |||
352 | static unsigned long clk_pll1_sw_get_rate(struct clk *clk) | ||
353 | { | ||
354 | u32 reg, div; | ||
355 | unsigned long parent_rate; | ||
356 | |||
357 | parent_rate = clk_get_rate(clk->parent); | ||
358 | |||
359 | reg = __raw_readl(MXC_CCM_CCSR); | ||
360 | |||
361 | if (clk->parent == &pll2_sw_clk) { | ||
362 | div = ((reg & MXC_CCM_CCSR_PLL2_PODF_MASK) >> | ||
363 | MXC_CCM_CCSR_PLL2_PODF_OFFSET) + 1; | ||
364 | } else if (clk->parent == &pll3_sw_clk) { | ||
365 | div = ((reg & MXC_CCM_CCSR_PLL3_PODF_MASK) >> | ||
366 | MXC_CCM_CCSR_PLL3_PODF_OFFSET) + 1; | ||
367 | } else | ||
368 | div = 1; | ||
369 | return parent_rate / div; | ||
370 | } | ||
371 | |||
372 | static int _clk_pll2_sw_set_parent(struct clk *clk, struct clk *parent) | ||
373 | { | ||
374 | u32 reg; | ||
375 | |||
376 | reg = __raw_readl(MXC_CCM_CCSR); | ||
377 | |||
378 | if (parent == &pll2_sw_clk) | ||
379 | reg &= ~MXC_CCM_CCSR_PLL2_SW_CLK_SEL; | ||
380 | else | ||
381 | reg |= MXC_CCM_CCSR_PLL2_SW_CLK_SEL; | ||
382 | |||
383 | __raw_writel(reg, MXC_CCM_CCSR); | ||
384 | return 0; | ||
385 | } | ||
386 | |||
387 | static int _clk_lp_apm_set_parent(struct clk *clk, struct clk *parent) | ||
388 | { | ||
389 | u32 reg; | ||
390 | |||
391 | if (parent == &osc_clk) | ||
392 | reg = __raw_readl(MXC_CCM_CCSR) & ~MXC_CCM_CCSR_LP_APM_SEL; | ||
393 | else | ||
394 | return -EINVAL; | ||
395 | |||
396 | __raw_writel(reg, MXC_CCM_CCSR); | ||
397 | |||
398 | return 0; | ||
399 | } | ||
400 | |||
401 | static unsigned long clk_cpu_get_rate(struct clk *clk) | ||
402 | { | ||
403 | u32 cacrr, div; | ||
404 | unsigned long parent_rate; | ||
405 | |||
406 | parent_rate = clk_get_rate(clk->parent); | ||
407 | cacrr = __raw_readl(MXC_CCM_CACRR); | ||
408 | div = (cacrr & MXC_CCM_CACRR_ARM_PODF_MASK) + 1; | ||
409 | |||
410 | return parent_rate / div; | ||
411 | } | ||
412 | |||
413 | static int clk_cpu_set_rate(struct clk *clk, unsigned long rate) | ||
414 | { | ||
415 | u32 reg, cpu_podf; | ||
416 | unsigned long parent_rate; | ||
417 | |||
418 | parent_rate = clk_get_rate(clk->parent); | ||
419 | cpu_podf = parent_rate / rate - 1; | ||
420 | /* use post divider to change freq */ | ||
421 | reg = __raw_readl(MXC_CCM_CACRR); | ||
422 | reg &= ~MXC_CCM_CACRR_ARM_PODF_MASK; | ||
423 | reg |= cpu_podf << MXC_CCM_CACRR_ARM_PODF_OFFSET; | ||
424 | __raw_writel(reg, MXC_CCM_CACRR); | ||
425 | |||
426 | return 0; | ||
427 | } | ||
428 | |||
429 | static int _clk_periph_apm_set_parent(struct clk *clk, struct clk *parent) | ||
430 | { | ||
431 | u32 reg, mux; | ||
432 | int i = 0; | ||
433 | |||
434 | mux = _get_mux(parent, &pll1_sw_clk, &pll3_sw_clk, &lp_apm_clk, NULL); | ||
435 | |||
436 | reg = __raw_readl(MXC_CCM_CBCMR) & ~MXC_CCM_CBCMR_PERIPH_CLK_SEL_MASK; | ||
437 | reg |= mux << MXC_CCM_CBCMR_PERIPH_CLK_SEL_OFFSET; | ||
438 | __raw_writel(reg, MXC_CCM_CBCMR); | ||
439 | |||
440 | /* Wait for lock */ | ||
441 | do { | ||
442 | reg = __raw_readl(MXC_CCM_CDHIPR); | ||
443 | if (!(reg & MXC_CCM_CDHIPR_PERIPH_CLK_SEL_BUSY)) | ||
444 | break; | ||
445 | |||
446 | udelay(1); | ||
447 | } while (++i < MAX_DPLL_WAIT_TRIES); | ||
448 | |||
449 | if (i == MAX_DPLL_WAIT_TRIES) { | ||
450 | pr_err("MX5: Set parent for periph_apm clock failed\n"); | ||
451 | return -EINVAL; | ||
452 | } | ||
453 | |||
454 | return 0; | ||
455 | } | ||
456 | |||
457 | static int _clk_main_bus_set_parent(struct clk *clk, struct clk *parent) | ||
458 | { | ||
459 | u32 reg; | ||
460 | |||
461 | reg = __raw_readl(MXC_CCM_CBCDR); | ||
462 | |||
463 | if (parent == &pll2_sw_clk) | ||
464 | reg &= ~MXC_CCM_CBCDR_PERIPH_CLK_SEL; | ||
465 | else if (parent == &periph_apm_clk) | ||
466 | reg |= MXC_CCM_CBCDR_PERIPH_CLK_SEL; | ||
467 | else | ||
468 | return -EINVAL; | ||
469 | |||
470 | __raw_writel(reg, MXC_CCM_CBCDR); | ||
471 | |||
472 | return 0; | ||
473 | } | ||
474 | |||
475 | static struct clk main_bus_clk = { | ||
476 | .parent = &pll2_sw_clk, | ||
477 | .set_parent = _clk_main_bus_set_parent, | ||
478 | }; | ||
479 | |||
480 | static unsigned long clk_ahb_get_rate(struct clk *clk) | ||
481 | { | ||
482 | u32 reg, div; | ||
483 | unsigned long parent_rate; | ||
484 | |||
485 | parent_rate = clk_get_rate(clk->parent); | ||
486 | |||
487 | reg = __raw_readl(MXC_CCM_CBCDR); | ||
488 | div = ((reg & MXC_CCM_CBCDR_AHB_PODF_MASK) >> | ||
489 | MXC_CCM_CBCDR_AHB_PODF_OFFSET) + 1; | ||
490 | return parent_rate / div; | ||
491 | } | ||
492 | |||
493 | |||
494 | static int _clk_ahb_set_rate(struct clk *clk, unsigned long rate) | ||
495 | { | ||
496 | u32 reg, div; | ||
497 | unsigned long parent_rate; | ||
498 | int i = 0; | ||
499 | |||
500 | parent_rate = clk_get_rate(clk->parent); | ||
501 | |||
502 | div = parent_rate / rate; | ||
503 | if (div > 8 || div < 1 || ((parent_rate / div) != rate)) | ||
504 | return -EINVAL; | ||
505 | |||
506 | reg = __raw_readl(MXC_CCM_CBCDR); | ||
507 | reg &= ~MXC_CCM_CBCDR_AHB_PODF_MASK; | ||
508 | reg |= (div - 1) << MXC_CCM_CBCDR_AHB_PODF_OFFSET; | ||
509 | __raw_writel(reg, MXC_CCM_CBCDR); | ||
510 | |||
511 | /* Wait for lock */ | ||
512 | do { | ||
513 | reg = __raw_readl(MXC_CCM_CDHIPR); | ||
514 | if (!(reg & MXC_CCM_CDHIPR_AHB_PODF_BUSY)) | ||
515 | break; | ||
516 | |||
517 | udelay(1); | ||
518 | } while (++i < MAX_DPLL_WAIT_TRIES); | ||
519 | |||
520 | if (i == MAX_DPLL_WAIT_TRIES) { | ||
521 | pr_err("MX5: clk_ahb_set_rate failed\n"); | ||
522 | return -EINVAL; | ||
523 | } | ||
524 | |||
525 | return 0; | ||
526 | } | ||
527 | |||
528 | static unsigned long _clk_ahb_round_rate(struct clk *clk, | ||
529 | unsigned long rate) | ||
530 | { | ||
531 | u32 div; | ||
532 | unsigned long parent_rate; | ||
533 | |||
534 | parent_rate = clk_get_rate(clk->parent); | ||
535 | |||
536 | div = parent_rate / rate; | ||
537 | if (div > 8) | ||
538 | div = 8; | ||
539 | else if (div == 0) | ||
540 | div++; | ||
541 | return parent_rate / div; | ||
542 | } | ||
543 | |||
544 | |||
545 | static int _clk_max_enable(struct clk *clk) | ||
546 | { | ||
547 | u32 reg; | ||
548 | |||
549 | _clk_ccgr_enable(clk); | ||
550 | |||
551 | /* Handshake with MAX when LPM is entered. */ | ||
552 | reg = __raw_readl(MXC_CCM_CLPCR); | ||
553 | if (cpu_is_mx51()) | ||
554 | reg &= ~MX51_CCM_CLPCR_BYPASS_MAX_LPM_HS; | ||
555 | else if (cpu_is_mx53()) | ||
556 | reg &= ~MX53_CCM_CLPCR_BYPASS_MAX_LPM_HS; | ||
557 | __raw_writel(reg, MXC_CCM_CLPCR); | ||
558 | |||
559 | return 0; | ||
560 | } | ||
561 | |||
562 | static void _clk_max_disable(struct clk *clk) | ||
563 | { | ||
564 | u32 reg; | ||
565 | |||
566 | _clk_ccgr_disable_inwait(clk); | ||
567 | |||
568 | /* No Handshake with MAX when LPM is entered as its disabled. */ | ||
569 | reg = __raw_readl(MXC_CCM_CLPCR); | ||
570 | if (cpu_is_mx51()) | ||
571 | reg |= MX51_CCM_CLPCR_BYPASS_MAX_LPM_HS; | ||
572 | else if (cpu_is_mx53()) | ||
573 | reg &= ~MX53_CCM_CLPCR_BYPASS_MAX_LPM_HS; | ||
574 | __raw_writel(reg, MXC_CCM_CLPCR); | ||
575 | } | ||
576 | |||
577 | static unsigned long clk_ipg_get_rate(struct clk *clk) | ||
578 | { | ||
579 | u32 reg, div; | ||
580 | unsigned long parent_rate; | ||
581 | |||
582 | parent_rate = clk_get_rate(clk->parent); | ||
583 | |||
584 | reg = __raw_readl(MXC_CCM_CBCDR); | ||
585 | div = ((reg & MXC_CCM_CBCDR_IPG_PODF_MASK) >> | ||
586 | MXC_CCM_CBCDR_IPG_PODF_OFFSET) + 1; | ||
587 | |||
588 | return parent_rate / div; | ||
589 | } | ||
590 | |||
591 | static unsigned long clk_ipg_per_get_rate(struct clk *clk) | ||
592 | { | ||
593 | u32 reg, prediv1, prediv2, podf; | ||
594 | unsigned long parent_rate; | ||
595 | |||
596 | parent_rate = clk_get_rate(clk->parent); | ||
597 | |||
598 | if (clk->parent == &main_bus_clk || clk->parent == &lp_apm_clk) { | ||
599 | /* the main_bus_clk is the one before the DVFS engine */ | ||
600 | reg = __raw_readl(MXC_CCM_CBCDR); | ||
601 | prediv1 = ((reg & MXC_CCM_CBCDR_PERCLK_PRED1_MASK) >> | ||
602 | MXC_CCM_CBCDR_PERCLK_PRED1_OFFSET) + 1; | ||
603 | prediv2 = ((reg & MXC_CCM_CBCDR_PERCLK_PRED2_MASK) >> | ||
604 | MXC_CCM_CBCDR_PERCLK_PRED2_OFFSET) + 1; | ||
605 | podf = ((reg & MXC_CCM_CBCDR_PERCLK_PODF_MASK) >> | ||
606 | MXC_CCM_CBCDR_PERCLK_PODF_OFFSET) + 1; | ||
607 | return parent_rate / (prediv1 * prediv2 * podf); | ||
608 | } else if (clk->parent == &ipg_clk) | ||
609 | return parent_rate; | ||
610 | else | ||
611 | BUG(); | ||
612 | } | ||
613 | |||
614 | static int _clk_ipg_per_set_parent(struct clk *clk, struct clk *parent) | ||
615 | { | ||
616 | u32 reg; | ||
617 | |||
618 | reg = __raw_readl(MXC_CCM_CBCMR); | ||
619 | |||
620 | reg &= ~MXC_CCM_CBCMR_PERCLK_LP_APM_CLK_SEL; | ||
621 | reg &= ~MXC_CCM_CBCMR_PERCLK_IPG_CLK_SEL; | ||
622 | |||
623 | if (parent == &ipg_clk) | ||
624 | reg |= MXC_CCM_CBCMR_PERCLK_IPG_CLK_SEL; | ||
625 | else if (parent == &lp_apm_clk) | ||
626 | reg |= MXC_CCM_CBCMR_PERCLK_LP_APM_CLK_SEL; | ||
627 | else if (parent != &main_bus_clk) | ||
628 | return -EINVAL; | ||
629 | |||
630 | __raw_writel(reg, MXC_CCM_CBCMR); | ||
631 | |||
632 | return 0; | ||
633 | } | ||
634 | |||
635 | #define clk_nfc_set_parent NULL | ||
636 | |||
637 | static unsigned long clk_nfc_get_rate(struct clk *clk) | ||
638 | { | ||
639 | unsigned long rate; | ||
640 | u32 reg, div; | ||
641 | |||
642 | reg = __raw_readl(MXC_CCM_CBCDR); | ||
643 | div = ((reg & MXC_CCM_CBCDR_NFC_PODF_MASK) >> | ||
644 | MXC_CCM_CBCDR_NFC_PODF_OFFSET) + 1; | ||
645 | rate = clk_get_rate(clk->parent) / div; | ||
646 | WARN_ON(rate == 0); | ||
647 | return rate; | ||
648 | } | ||
649 | |||
650 | static unsigned long clk_nfc_round_rate(struct clk *clk, | ||
651 | unsigned long rate) | ||
652 | { | ||
653 | u32 div; | ||
654 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
655 | |||
656 | if (!rate) | ||
657 | return -EINVAL; | ||
658 | |||
659 | div = parent_rate / rate; | ||
660 | |||
661 | if (parent_rate % rate) | ||
662 | div++; | ||
663 | |||
664 | if (div > 8) | ||
665 | return -EINVAL; | ||
666 | |||
667 | return parent_rate / div; | ||
668 | |||
669 | } | ||
670 | |||
671 | static int clk_nfc_set_rate(struct clk *clk, unsigned long rate) | ||
672 | { | ||
673 | u32 reg, div; | ||
674 | |||
675 | div = clk_get_rate(clk->parent) / rate; | ||
676 | if (div == 0) | ||
677 | div++; | ||
678 | if (((clk_get_rate(clk->parent) / div) != rate) || (div > 8)) | ||
679 | return -EINVAL; | ||
680 | |||
681 | reg = __raw_readl(MXC_CCM_CBCDR); | ||
682 | reg &= ~MXC_CCM_CBCDR_NFC_PODF_MASK; | ||
683 | reg |= (div - 1) << MXC_CCM_CBCDR_NFC_PODF_OFFSET; | ||
684 | __raw_writel(reg, MXC_CCM_CBCDR); | ||
685 | |||
686 | while (__raw_readl(MXC_CCM_CDHIPR) & | ||
687 | MXC_CCM_CDHIPR_NFC_IPG_INT_MEM_PODF_BUSY){ | ||
688 | } | ||
689 | |||
690 | return 0; | ||
691 | } | ||
692 | |||
693 | static unsigned long get_high_reference_clock_rate(struct clk *clk) | ||
694 | { | ||
695 | return external_high_reference; | ||
696 | } | ||
697 | |||
698 | static unsigned long get_low_reference_clock_rate(struct clk *clk) | ||
699 | { | ||
700 | return external_low_reference; | ||
701 | } | ||
702 | |||
703 | static unsigned long get_oscillator_reference_clock_rate(struct clk *clk) | ||
704 | { | ||
705 | return oscillator_reference; | ||
706 | } | ||
707 | |||
708 | static unsigned long get_ckih2_reference_clock_rate(struct clk *clk) | ||
709 | { | ||
710 | return ckih2_reference; | ||
711 | } | ||
712 | |||
713 | static unsigned long clk_emi_slow_get_rate(struct clk *clk) | ||
714 | { | ||
715 | u32 reg, div; | ||
716 | |||
717 | reg = __raw_readl(MXC_CCM_CBCDR); | ||
718 | div = ((reg & MXC_CCM_CBCDR_EMI_PODF_MASK) >> | ||
719 | MXC_CCM_CBCDR_EMI_PODF_OFFSET) + 1; | ||
720 | |||
721 | return clk_get_rate(clk->parent) / div; | ||
722 | } | ||
723 | |||
724 | static unsigned long _clk_ddr_hf_get_rate(struct clk *clk) | ||
725 | { | ||
726 | unsigned long rate; | ||
727 | u32 reg, div; | ||
728 | |||
729 | reg = __raw_readl(MXC_CCM_CBCDR); | ||
730 | div = ((reg & MXC_CCM_CBCDR_DDR_PODF_MASK) >> | ||
731 | MXC_CCM_CBCDR_DDR_PODF_OFFSET) + 1; | ||
732 | rate = clk_get_rate(clk->parent) / div; | ||
733 | |||
734 | return rate; | ||
735 | } | ||
736 | |||
737 | /* External high frequency clock */ | ||
738 | static struct clk ckih_clk = { | ||
739 | .get_rate = get_high_reference_clock_rate, | ||
740 | }; | ||
741 | |||
742 | static struct clk ckih2_clk = { | ||
743 | .get_rate = get_ckih2_reference_clock_rate, | ||
744 | }; | ||
745 | |||
746 | static struct clk osc_clk = { | ||
747 | .get_rate = get_oscillator_reference_clock_rate, | ||
748 | }; | ||
749 | |||
750 | /* External low frequency (32kHz) clock */ | ||
751 | static struct clk ckil_clk = { | ||
752 | .get_rate = get_low_reference_clock_rate, | ||
753 | }; | ||
754 | |||
755 | static struct clk pll1_main_clk = { | ||
756 | .parent = &osc_clk, | ||
757 | .get_rate = clk_pll_get_rate, | ||
758 | .enable = _clk_pll_enable, | ||
759 | .disable = _clk_pll_disable, | ||
760 | }; | ||
761 | |||
762 | /* Clock tree block diagram (WIP): | ||
763 | * CCM: Clock Controller Module | ||
764 | * | ||
765 | * PLL output -> | | ||
766 | * | CCM Switcher -> CCM_CLK_ROOT_GEN -> | ||
767 | * PLL bypass -> | | ||
768 | * | ||
769 | */ | ||
770 | |||
771 | /* PLL1 SW supplies to ARM core */ | ||
772 | static struct clk pll1_sw_clk = { | ||
773 | .parent = &pll1_main_clk, | ||
774 | .set_parent = _clk_pll1_sw_set_parent, | ||
775 | .get_rate = clk_pll1_sw_get_rate, | ||
776 | }; | ||
777 | |||
778 | /* PLL2 SW supplies to AXI/AHB/IP buses */ | ||
779 | static struct clk pll2_sw_clk = { | ||
780 | .parent = &osc_clk, | ||
781 | .get_rate = clk_pll_get_rate, | ||
782 | .set_rate = _clk_pll_set_rate, | ||
783 | .set_parent = _clk_pll2_sw_set_parent, | ||
784 | .enable = _clk_pll_enable, | ||
785 | .disable = _clk_pll_disable, | ||
786 | }; | ||
787 | |||
788 | /* PLL3 SW supplies to serial clocks like USB, SSI, etc. */ | ||
789 | static struct clk pll3_sw_clk = { | ||
790 | .parent = &osc_clk, | ||
791 | .set_rate = _clk_pll_set_rate, | ||
792 | .get_rate = clk_pll_get_rate, | ||
793 | .enable = _clk_pll_enable, | ||
794 | .disable = _clk_pll_disable, | ||
795 | }; | ||
796 | |||
797 | /* PLL4 SW supplies to LVDS Display Bridge(LDB) */ | ||
798 | static struct clk mx53_pll4_sw_clk = { | ||
799 | .parent = &osc_clk, | ||
800 | .set_rate = _clk_pll_set_rate, | ||
801 | .enable = _clk_pll_enable, | ||
802 | .disable = _clk_pll_disable, | ||
803 | }; | ||
804 | |||
805 | /* Low-power Audio Playback Mode clock */ | ||
806 | static struct clk lp_apm_clk = { | ||
807 | .parent = &osc_clk, | ||
808 | .set_parent = _clk_lp_apm_set_parent, | ||
809 | }; | ||
810 | |||
811 | static struct clk periph_apm_clk = { | ||
812 | .parent = &pll1_sw_clk, | ||
813 | .set_parent = _clk_periph_apm_set_parent, | ||
814 | }; | ||
815 | |||
816 | static struct clk cpu_clk = { | ||
817 | .parent = &pll1_sw_clk, | ||
818 | .get_rate = clk_cpu_get_rate, | ||
819 | .set_rate = clk_cpu_set_rate, | ||
820 | }; | ||
821 | |||
822 | static struct clk ahb_clk = { | ||
823 | .parent = &main_bus_clk, | ||
824 | .get_rate = clk_ahb_get_rate, | ||
825 | .set_rate = _clk_ahb_set_rate, | ||
826 | .round_rate = _clk_ahb_round_rate, | ||
827 | }; | ||
828 | |||
829 | static struct clk iim_clk = { | ||
830 | .parent = &ipg_clk, | ||
831 | .enable_reg = MXC_CCM_CCGR0, | ||
832 | .enable_shift = MXC_CCM_CCGRx_CG15_OFFSET, | ||
833 | }; | ||
834 | |||
835 | /* Main IP interface clock for access to registers */ | ||
836 | static struct clk ipg_clk = { | ||
837 | .parent = &ahb_clk, | ||
838 | .get_rate = clk_ipg_get_rate, | ||
839 | }; | ||
840 | |||
841 | static struct clk ipg_perclk = { | ||
842 | .parent = &lp_apm_clk, | ||
843 | .get_rate = clk_ipg_per_get_rate, | ||
844 | .set_parent = _clk_ipg_per_set_parent, | ||
845 | }; | ||
846 | |||
847 | static struct clk ahb_max_clk = { | ||
848 | .parent = &ahb_clk, | ||
849 | .enable_reg = MXC_CCM_CCGR0, | ||
850 | .enable_shift = MXC_CCM_CCGRx_CG14_OFFSET, | ||
851 | .enable = _clk_max_enable, | ||
852 | .disable = _clk_max_disable, | ||
853 | }; | ||
854 | |||
855 | static struct clk aips_tz1_clk = { | ||
856 | .parent = &ahb_clk, | ||
857 | .secondary = &ahb_max_clk, | ||
858 | .enable_reg = MXC_CCM_CCGR0, | ||
859 | .enable_shift = MXC_CCM_CCGRx_CG12_OFFSET, | ||
860 | .enable = _clk_ccgr_enable, | ||
861 | .disable = _clk_ccgr_disable_inwait, | ||
862 | }; | ||
863 | |||
864 | static struct clk aips_tz2_clk = { | ||
865 | .parent = &ahb_clk, | ||
866 | .secondary = &ahb_max_clk, | ||
867 | .enable_reg = MXC_CCM_CCGR0, | ||
868 | .enable_shift = MXC_CCM_CCGRx_CG13_OFFSET, | ||
869 | .enable = _clk_ccgr_enable, | ||
870 | .disable = _clk_ccgr_disable_inwait, | ||
871 | }; | ||
872 | |||
873 | static struct clk gpc_dvfs_clk = { | ||
874 | .enable_reg = MXC_CCM_CCGR5, | ||
875 | .enable_shift = MXC_CCM_CCGRx_CG12_OFFSET, | ||
876 | .enable = _clk_ccgr_enable, | ||
877 | .disable = _clk_ccgr_disable, | ||
878 | }; | ||
879 | |||
880 | static struct clk gpt_32k_clk = { | ||
881 | .id = 0, | ||
882 | .parent = &ckil_clk, | ||
883 | }; | ||
884 | |||
885 | static struct clk dummy_clk = { | ||
886 | .id = 0, | ||
887 | }; | ||
888 | |||
889 | static struct clk emi_slow_clk = { | ||
890 | .parent = &pll2_sw_clk, | ||
891 | .enable_reg = MXC_CCM_CCGR5, | ||
892 | .enable_shift = MXC_CCM_CCGRx_CG8_OFFSET, | ||
893 | .enable = _clk_ccgr_enable, | ||
894 | .disable = _clk_ccgr_disable_inwait, | ||
895 | .get_rate = clk_emi_slow_get_rate, | ||
896 | }; | ||
897 | |||
898 | static int clk_ipu_enable(struct clk *clk) | ||
899 | { | ||
900 | u32 reg; | ||
901 | |||
902 | _clk_ccgr_enable(clk); | ||
903 | |||
904 | /* Enable handshake with IPU when certain clock rates are changed */ | ||
905 | reg = __raw_readl(MXC_CCM_CCDR); | ||
906 | reg &= ~MXC_CCM_CCDR_IPU_HS_MASK; | ||
907 | __raw_writel(reg, MXC_CCM_CCDR); | ||
908 | |||
909 | /* Enable handshake with IPU when LPM is entered */ | ||
910 | reg = __raw_readl(MXC_CCM_CLPCR); | ||
911 | reg &= ~MXC_CCM_CLPCR_BYPASS_IPU_LPM_HS; | ||
912 | __raw_writel(reg, MXC_CCM_CLPCR); | ||
913 | |||
914 | return 0; | ||
915 | } | ||
916 | |||
917 | static void clk_ipu_disable(struct clk *clk) | ||
918 | { | ||
919 | u32 reg; | ||
920 | |||
921 | _clk_ccgr_disable(clk); | ||
922 | |||
923 | /* Disable handshake with IPU whe dividers are changed */ | ||
924 | reg = __raw_readl(MXC_CCM_CCDR); | ||
925 | reg |= MXC_CCM_CCDR_IPU_HS_MASK; | ||
926 | __raw_writel(reg, MXC_CCM_CCDR); | ||
927 | |||
928 | /* Disable handshake with IPU when LPM is entered */ | ||
929 | reg = __raw_readl(MXC_CCM_CLPCR); | ||
930 | reg |= MXC_CCM_CLPCR_BYPASS_IPU_LPM_HS; | ||
931 | __raw_writel(reg, MXC_CCM_CLPCR); | ||
932 | } | ||
933 | |||
934 | static struct clk ahbmux1_clk = { | ||
935 | .parent = &ahb_clk, | ||
936 | .secondary = &ahb_max_clk, | ||
937 | .enable_reg = MXC_CCM_CCGR0, | ||
938 | .enable_shift = MXC_CCM_CCGRx_CG8_OFFSET, | ||
939 | .enable = _clk_ccgr_enable, | ||
940 | .disable = _clk_ccgr_disable_inwait, | ||
941 | }; | ||
942 | |||
943 | static struct clk ipu_sec_clk = { | ||
944 | .parent = &emi_fast_clk, | ||
945 | .secondary = &ahbmux1_clk, | ||
946 | }; | ||
947 | |||
948 | static struct clk ddr_hf_clk = { | ||
949 | .parent = &pll1_sw_clk, | ||
950 | .get_rate = _clk_ddr_hf_get_rate, | ||
951 | }; | ||
952 | |||
953 | static struct clk ddr_clk = { | ||
954 | .parent = &ddr_hf_clk, | ||
955 | }; | ||
956 | |||
957 | /* clock definitions for MIPI HSC unit which has been removed | ||
958 | * from documentation, but not from hardware | ||
959 | */ | ||
960 | static int _clk_hsc_enable(struct clk *clk) | ||
961 | { | ||
962 | u32 reg; | ||
963 | |||
964 | _clk_ccgr_enable(clk); | ||
965 | /* Handshake with IPU when certain clock rates are changed. */ | ||
966 | reg = __raw_readl(MXC_CCM_CCDR); | ||
967 | reg &= ~MXC_CCM_CCDR_HSC_HS_MASK; | ||
968 | __raw_writel(reg, MXC_CCM_CCDR); | ||
969 | |||
970 | reg = __raw_readl(MXC_CCM_CLPCR); | ||
971 | reg &= ~MXC_CCM_CLPCR_BYPASS_HSC_LPM_HS; | ||
972 | __raw_writel(reg, MXC_CCM_CLPCR); | ||
973 | |||
974 | return 0; | ||
975 | } | ||
976 | |||
977 | static void _clk_hsc_disable(struct clk *clk) | ||
978 | { | ||
979 | u32 reg; | ||
980 | |||
981 | _clk_ccgr_disable(clk); | ||
982 | /* No handshake with HSC as its not enabled. */ | ||
983 | reg = __raw_readl(MXC_CCM_CCDR); | ||
984 | reg |= MXC_CCM_CCDR_HSC_HS_MASK; | ||
985 | __raw_writel(reg, MXC_CCM_CCDR); | ||
986 | |||
987 | reg = __raw_readl(MXC_CCM_CLPCR); | ||
988 | reg |= MXC_CCM_CLPCR_BYPASS_HSC_LPM_HS; | ||
989 | __raw_writel(reg, MXC_CCM_CLPCR); | ||
990 | } | ||
991 | |||
992 | static struct clk mipi_hsp_clk = { | ||
993 | .parent = &ipu_clk, | ||
994 | .enable_reg = MXC_CCM_CCGR4, | ||
995 | .enable_shift = MXC_CCM_CCGRx_CG6_OFFSET, | ||
996 | .enable = _clk_hsc_enable, | ||
997 | .disable = _clk_hsc_disable, | ||
998 | .secondary = &mipi_hsc1_clk, | ||
999 | }; | ||
1000 | |||
1001 | #define DEFINE_CLOCK_CCGR(name, i, er, es, pfx, p, s) \ | ||
1002 | static struct clk name = { \ | ||
1003 | .id = i, \ | ||
1004 | .enable_reg = er, \ | ||
1005 | .enable_shift = es, \ | ||
1006 | .get_rate = pfx##_get_rate, \ | ||
1007 | .set_rate = pfx##_set_rate, \ | ||
1008 | .round_rate = pfx##_round_rate, \ | ||
1009 | .set_parent = pfx##_set_parent, \ | ||
1010 | .enable = _clk_ccgr_enable, \ | ||
1011 | .disable = _clk_ccgr_disable, \ | ||
1012 | .parent = p, \ | ||
1013 | .secondary = s, \ | ||
1014 | } | ||
1015 | |||
1016 | #define DEFINE_CLOCK_MAX(name, i, er, es, pfx, p, s) \ | ||
1017 | static struct clk name = { \ | ||
1018 | .id = i, \ | ||
1019 | .enable_reg = er, \ | ||
1020 | .enable_shift = es, \ | ||
1021 | .get_rate = pfx##_get_rate, \ | ||
1022 | .set_rate = pfx##_set_rate, \ | ||
1023 | .set_parent = pfx##_set_parent, \ | ||
1024 | .enable = _clk_max_enable, \ | ||
1025 | .disable = _clk_max_disable, \ | ||
1026 | .parent = p, \ | ||
1027 | .secondary = s, \ | ||
1028 | } | ||
1029 | |||
1030 | #define CLK_GET_RATE(name, nr, bitsname) \ | ||
1031 | static unsigned long clk_##name##_get_rate(struct clk *clk) \ | ||
1032 | { \ | ||
1033 | u32 reg, pred, podf; \ | ||
1034 | \ | ||
1035 | reg = __raw_readl(MXC_CCM_CSCDR##nr); \ | ||
1036 | pred = (reg & MXC_CCM_CSCDR##nr##_##bitsname##_CLK_PRED_MASK) \ | ||
1037 | >> MXC_CCM_CSCDR##nr##_##bitsname##_CLK_PRED_OFFSET; \ | ||
1038 | podf = (reg & MXC_CCM_CSCDR##nr##_##bitsname##_CLK_PODF_MASK) \ | ||
1039 | >> MXC_CCM_CSCDR##nr##_##bitsname##_CLK_PODF_OFFSET; \ | ||
1040 | \ | ||
1041 | return DIV_ROUND_CLOSEST(clk_get_rate(clk->parent), \ | ||
1042 | (pred + 1) * (podf + 1)); \ | ||
1043 | } | ||
1044 | |||
1045 | #define CLK_SET_PARENT(name, nr, bitsname) \ | ||
1046 | static int clk_##name##_set_parent(struct clk *clk, struct clk *parent) \ | ||
1047 | { \ | ||
1048 | u32 reg, mux; \ | ||
1049 | \ | ||
1050 | mux = _get_mux(parent, &pll1_sw_clk, &pll2_sw_clk, \ | ||
1051 | &pll3_sw_clk, &lp_apm_clk); \ | ||
1052 | reg = __raw_readl(MXC_CCM_CSCMR##nr) & \ | ||
1053 | ~MXC_CCM_CSCMR##nr##_##bitsname##_CLK_SEL_MASK; \ | ||
1054 | reg |= mux << MXC_CCM_CSCMR##nr##_##bitsname##_CLK_SEL_OFFSET; \ | ||
1055 | __raw_writel(reg, MXC_CCM_CSCMR##nr); \ | ||
1056 | \ | ||
1057 | return 0; \ | ||
1058 | } | ||
1059 | |||
1060 | #define CLK_SET_RATE(name, nr, bitsname) \ | ||
1061 | static int clk_##name##_set_rate(struct clk *clk, unsigned long rate) \ | ||
1062 | { \ | ||
1063 | u32 reg, div, parent_rate; \ | ||
1064 | u32 pre = 0, post = 0; \ | ||
1065 | \ | ||
1066 | parent_rate = clk_get_rate(clk->parent); \ | ||
1067 | div = parent_rate / rate; \ | ||
1068 | \ | ||
1069 | if ((parent_rate / div) != rate) \ | ||
1070 | return -EINVAL; \ | ||
1071 | \ | ||
1072 | __calc_pre_post_dividers(div, &pre, &post, \ | ||
1073 | (MXC_CCM_CSCDR##nr##_##bitsname##_CLK_PRED_MASK >> \ | ||
1074 | MXC_CCM_CSCDR##nr##_##bitsname##_CLK_PRED_OFFSET) + 1, \ | ||
1075 | (MXC_CCM_CSCDR##nr##_##bitsname##_CLK_PODF_MASK >> \ | ||
1076 | MXC_CCM_CSCDR##nr##_##bitsname##_CLK_PODF_OFFSET) + 1);\ | ||
1077 | \ | ||
1078 | /* Set sdhc1 clock divider */ \ | ||
1079 | reg = __raw_readl(MXC_CCM_CSCDR##nr) & \ | ||
1080 | ~(MXC_CCM_CSCDR##nr##_##bitsname##_CLK_PRED_MASK \ | ||
1081 | | MXC_CCM_CSCDR##nr##_##bitsname##_CLK_PODF_MASK); \ | ||
1082 | reg |= (post - 1) << \ | ||
1083 | MXC_CCM_CSCDR##nr##_##bitsname##_CLK_PODF_OFFSET; \ | ||
1084 | reg |= (pre - 1) << \ | ||
1085 | MXC_CCM_CSCDR##nr##_##bitsname##_CLK_PRED_OFFSET; \ | ||
1086 | __raw_writel(reg, MXC_CCM_CSCDR##nr); \ | ||
1087 | \ | ||
1088 | return 0; \ | ||
1089 | } | ||
1090 | |||
1091 | /* UART */ | ||
1092 | CLK_GET_RATE(uart, 1, UART) | ||
1093 | CLK_SET_PARENT(uart, 1, UART) | ||
1094 | |||
1095 | static struct clk uart_root_clk = { | ||
1096 | .parent = &pll2_sw_clk, | ||
1097 | .get_rate = clk_uart_get_rate, | ||
1098 | .set_parent = clk_uart_set_parent, | ||
1099 | }; | ||
1100 | |||
1101 | /* USBOH3 */ | ||
1102 | CLK_GET_RATE(usboh3, 1, USBOH3) | ||
1103 | CLK_SET_PARENT(usboh3, 1, USBOH3) | ||
1104 | |||
1105 | static struct clk usboh3_clk = { | ||
1106 | .parent = &pll2_sw_clk, | ||
1107 | .get_rate = clk_usboh3_get_rate, | ||
1108 | .set_parent = clk_usboh3_set_parent, | ||
1109 | .enable = _clk_ccgr_enable, | ||
1110 | .disable = _clk_ccgr_disable, | ||
1111 | .enable_reg = MXC_CCM_CCGR2, | ||
1112 | .enable_shift = MXC_CCM_CCGRx_CG14_OFFSET, | ||
1113 | }; | ||
1114 | |||
1115 | static struct clk usb_ahb_clk = { | ||
1116 | .parent = &ipg_clk, | ||
1117 | .enable = _clk_ccgr_enable, | ||
1118 | .disable = _clk_ccgr_disable, | ||
1119 | .enable_reg = MXC_CCM_CCGR2, | ||
1120 | .enable_shift = MXC_CCM_CCGRx_CG13_OFFSET, | ||
1121 | }; | ||
1122 | |||
1123 | static int clk_usb_phy1_set_parent(struct clk *clk, struct clk *parent) | ||
1124 | { | ||
1125 | u32 reg; | ||
1126 | |||
1127 | reg = __raw_readl(MXC_CCM_CSCMR1) & ~MXC_CCM_CSCMR1_USB_PHY_CLK_SEL; | ||
1128 | |||
1129 | if (parent == &pll3_sw_clk) | ||
1130 | reg |= 1 << MXC_CCM_CSCMR1_USB_PHY_CLK_SEL_OFFSET; | ||
1131 | |||
1132 | __raw_writel(reg, MXC_CCM_CSCMR1); | ||
1133 | |||
1134 | return 0; | ||
1135 | } | ||
1136 | |||
1137 | static struct clk usb_phy1_clk = { | ||
1138 | .parent = &pll3_sw_clk, | ||
1139 | .set_parent = clk_usb_phy1_set_parent, | ||
1140 | .enable = _clk_ccgr_enable, | ||
1141 | .enable_reg = MXC_CCM_CCGR2, | ||
1142 | .enable_shift = MXC_CCM_CCGRx_CG0_OFFSET, | ||
1143 | .disable = _clk_ccgr_disable, | ||
1144 | }; | ||
1145 | |||
1146 | /* eCSPI */ | ||
1147 | CLK_GET_RATE(ecspi, 2, CSPI) | ||
1148 | CLK_SET_PARENT(ecspi, 1, CSPI) | ||
1149 | |||
1150 | static struct clk ecspi_main_clk = { | ||
1151 | .parent = &pll3_sw_clk, | ||
1152 | .get_rate = clk_ecspi_get_rate, | ||
1153 | .set_parent = clk_ecspi_set_parent, | ||
1154 | }; | ||
1155 | |||
1156 | /* eSDHC */ | ||
1157 | CLK_GET_RATE(esdhc1, 1, ESDHC1_MSHC1) | ||
1158 | CLK_SET_PARENT(esdhc1, 1, ESDHC1_MSHC1) | ||
1159 | CLK_SET_RATE(esdhc1, 1, ESDHC1_MSHC1) | ||
1160 | |||
1161 | /* mx51 specific */ | ||
1162 | CLK_GET_RATE(esdhc2, 1, ESDHC2_MSHC2) | ||
1163 | CLK_SET_PARENT(esdhc2, 1, ESDHC2_MSHC2) | ||
1164 | CLK_SET_RATE(esdhc2, 1, ESDHC2_MSHC2) | ||
1165 | |||
1166 | static int clk_esdhc3_set_parent(struct clk *clk, struct clk *parent) | ||
1167 | { | ||
1168 | u32 reg; | ||
1169 | |||
1170 | reg = __raw_readl(MXC_CCM_CSCMR1); | ||
1171 | if (parent == &esdhc1_clk) | ||
1172 | reg &= ~MXC_CCM_CSCMR1_ESDHC3_CLK_SEL; | ||
1173 | else if (parent == &esdhc2_clk) | ||
1174 | reg |= MXC_CCM_CSCMR1_ESDHC3_CLK_SEL; | ||
1175 | else | ||
1176 | return -EINVAL; | ||
1177 | __raw_writel(reg, MXC_CCM_CSCMR1); | ||
1178 | |||
1179 | return 0; | ||
1180 | } | ||
1181 | |||
1182 | static int clk_esdhc4_set_parent(struct clk *clk, struct clk *parent) | ||
1183 | { | ||
1184 | u32 reg; | ||
1185 | |||
1186 | reg = __raw_readl(MXC_CCM_CSCMR1); | ||
1187 | if (parent == &esdhc1_clk) | ||
1188 | reg &= ~MXC_CCM_CSCMR1_ESDHC4_CLK_SEL; | ||
1189 | else if (parent == &esdhc2_clk) | ||
1190 | reg |= MXC_CCM_CSCMR1_ESDHC4_CLK_SEL; | ||
1191 | else | ||
1192 | return -EINVAL; | ||
1193 | __raw_writel(reg, MXC_CCM_CSCMR1); | ||
1194 | |||
1195 | return 0; | ||
1196 | } | ||
1197 | |||
1198 | /* mx53 specific */ | ||
1199 | static int clk_esdhc2_mx53_set_parent(struct clk *clk, struct clk *parent) | ||
1200 | { | ||
1201 | u32 reg; | ||
1202 | |||
1203 | reg = __raw_readl(MXC_CCM_CSCMR1); | ||
1204 | if (parent == &esdhc1_clk) | ||
1205 | reg &= ~MXC_CCM_CSCMR1_ESDHC2_MSHC2_MX53_CLK_SEL; | ||
1206 | else if (parent == &esdhc3_mx53_clk) | ||
1207 | reg |= MXC_CCM_CSCMR1_ESDHC2_MSHC2_MX53_CLK_SEL; | ||
1208 | else | ||
1209 | return -EINVAL; | ||
1210 | __raw_writel(reg, MXC_CCM_CSCMR1); | ||
1211 | |||
1212 | return 0; | ||
1213 | } | ||
1214 | |||
1215 | CLK_GET_RATE(esdhc3_mx53, 1, ESDHC3_MX53) | ||
1216 | CLK_SET_PARENT(esdhc3_mx53, 1, ESDHC3_MX53) | ||
1217 | CLK_SET_RATE(esdhc3_mx53, 1, ESDHC3_MX53) | ||
1218 | |||
1219 | static int clk_esdhc4_mx53_set_parent(struct clk *clk, struct clk *parent) | ||
1220 | { | ||
1221 | u32 reg; | ||
1222 | |||
1223 | reg = __raw_readl(MXC_CCM_CSCMR1); | ||
1224 | if (parent == &esdhc1_clk) | ||
1225 | reg &= ~MXC_CCM_CSCMR1_ESDHC4_CLK_SEL; | ||
1226 | else if (parent == &esdhc3_mx53_clk) | ||
1227 | reg |= MXC_CCM_CSCMR1_ESDHC4_CLK_SEL; | ||
1228 | else | ||
1229 | return -EINVAL; | ||
1230 | __raw_writel(reg, MXC_CCM_CSCMR1); | ||
1231 | |||
1232 | return 0; | ||
1233 | } | ||
1234 | |||
1235 | #define DEFINE_CLOCK_FULL(name, i, er, es, gr, sr, e, d, p, s) \ | ||
1236 | static struct clk name = { \ | ||
1237 | .id = i, \ | ||
1238 | .enable_reg = er, \ | ||
1239 | .enable_shift = es, \ | ||
1240 | .get_rate = gr, \ | ||
1241 | .set_rate = sr, \ | ||
1242 | .enable = e, \ | ||
1243 | .disable = d, \ | ||
1244 | .parent = p, \ | ||
1245 | .secondary = s, \ | ||
1246 | } | ||
1247 | |||
1248 | #define DEFINE_CLOCK(name, i, er, es, gr, sr, p, s) \ | ||
1249 | DEFINE_CLOCK_FULL(name, i, er, es, gr, sr, _clk_ccgr_enable, _clk_ccgr_disable, p, s) | ||
1250 | |||
1251 | /* Shared peripheral bus arbiter */ | ||
1252 | DEFINE_CLOCK(spba_clk, 0, MXC_CCM_CCGR5, MXC_CCM_CCGRx_CG0_OFFSET, | ||
1253 | NULL, NULL, &ipg_clk, NULL); | ||
1254 | |||
1255 | /* UART */ | ||
1256 | DEFINE_CLOCK(uart1_ipg_clk, 0, MXC_CCM_CCGR1, MXC_CCM_CCGRx_CG3_OFFSET, | ||
1257 | NULL, NULL, &ipg_clk, &aips_tz1_clk); | ||
1258 | DEFINE_CLOCK(uart2_ipg_clk, 1, MXC_CCM_CCGR1, MXC_CCM_CCGRx_CG5_OFFSET, | ||
1259 | NULL, NULL, &ipg_clk, &aips_tz1_clk); | ||
1260 | DEFINE_CLOCK(uart3_ipg_clk, 2, MXC_CCM_CCGR1, MXC_CCM_CCGRx_CG7_OFFSET, | ||
1261 | NULL, NULL, &ipg_clk, &spba_clk); | ||
1262 | DEFINE_CLOCK(uart4_ipg_clk, 3, MXC_CCM_CCGR7, MXC_CCM_CCGRx_CG4_OFFSET, | ||
1263 | NULL, NULL, &ipg_clk, &spba_clk); | ||
1264 | DEFINE_CLOCK(uart5_ipg_clk, 4, MXC_CCM_CCGR7, MXC_CCM_CCGRx_CG6_OFFSET, | ||
1265 | NULL, NULL, &ipg_clk, &spba_clk); | ||
1266 | DEFINE_CLOCK(uart1_clk, 0, MXC_CCM_CCGR1, MXC_CCM_CCGRx_CG4_OFFSET, | ||
1267 | NULL, NULL, &uart_root_clk, &uart1_ipg_clk); | ||
1268 | DEFINE_CLOCK(uart2_clk, 1, MXC_CCM_CCGR1, MXC_CCM_CCGRx_CG6_OFFSET, | ||
1269 | NULL, NULL, &uart_root_clk, &uart2_ipg_clk); | ||
1270 | DEFINE_CLOCK(uart3_clk, 2, MXC_CCM_CCGR1, MXC_CCM_CCGRx_CG8_OFFSET, | ||
1271 | NULL, NULL, &uart_root_clk, &uart3_ipg_clk); | ||
1272 | DEFINE_CLOCK(uart4_clk, 3, MXC_CCM_CCGR7, MXC_CCM_CCGRx_CG5_OFFSET, | ||
1273 | NULL, NULL, &uart_root_clk, &uart4_ipg_clk); | ||
1274 | DEFINE_CLOCK(uart5_clk, 4, MXC_CCM_CCGR7, MXC_CCM_CCGRx_CG7_OFFSET, | ||
1275 | NULL, NULL, &uart_root_clk, &uart5_ipg_clk); | ||
1276 | |||
1277 | /* GPT */ | ||
1278 | DEFINE_CLOCK(gpt_ipg_clk, 0, MXC_CCM_CCGR2, MXC_CCM_CCGRx_CG10_OFFSET, | ||
1279 | NULL, NULL, &ipg_clk, NULL); | ||
1280 | DEFINE_CLOCK(gpt_clk, 0, MXC_CCM_CCGR2, MXC_CCM_CCGRx_CG9_OFFSET, | ||
1281 | NULL, NULL, &ipg_clk, &gpt_ipg_clk); | ||
1282 | |||
1283 | DEFINE_CLOCK(pwm1_clk, 0, MXC_CCM_CCGR2, MXC_CCM_CCGRx_CG6_OFFSET, | ||
1284 | NULL, NULL, &ipg_perclk, NULL); | ||
1285 | DEFINE_CLOCK(pwm2_clk, 0, MXC_CCM_CCGR2, MXC_CCM_CCGRx_CG8_OFFSET, | ||
1286 | NULL, NULL, &ipg_perclk, NULL); | ||
1287 | |||
1288 | /* I2C */ | ||
1289 | DEFINE_CLOCK(i2c1_clk, 0, MXC_CCM_CCGR1, MXC_CCM_CCGRx_CG9_OFFSET, | ||
1290 | NULL, NULL, &ipg_perclk, NULL); | ||
1291 | DEFINE_CLOCK(i2c2_clk, 1, MXC_CCM_CCGR1, MXC_CCM_CCGRx_CG10_OFFSET, | ||
1292 | NULL, NULL, &ipg_perclk, NULL); | ||
1293 | DEFINE_CLOCK(hsi2c_clk, 0, MXC_CCM_CCGR1, MXC_CCM_CCGRx_CG11_OFFSET, | ||
1294 | NULL, NULL, &ipg_clk, NULL); | ||
1295 | DEFINE_CLOCK(i2c3_mx53_clk, 0, MXC_CCM_CCGR1, MXC_CCM_CCGRx_CG11_OFFSET, | ||
1296 | NULL, NULL, &ipg_perclk, NULL); | ||
1297 | |||
1298 | /* FEC */ | ||
1299 | DEFINE_CLOCK(fec_clk, 0, MXC_CCM_CCGR2, MXC_CCM_CCGRx_CG12_OFFSET, | ||
1300 | NULL, NULL, &ipg_clk, NULL); | ||
1301 | |||
1302 | /* NFC */ | ||
1303 | DEFINE_CLOCK_CCGR(nfc_clk, 0, MXC_CCM_CCGR5, MXC_CCM_CCGRx_CG10_OFFSET, | ||
1304 | clk_nfc, &emi_slow_clk, NULL); | ||
1305 | |||
1306 | /* SSI */ | ||
1307 | DEFINE_CLOCK(ssi1_ipg_clk, 0, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG8_OFFSET, | ||
1308 | NULL, NULL, &ipg_clk, NULL); | ||
1309 | DEFINE_CLOCK(ssi1_clk, 0, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG9_OFFSET, | ||
1310 | NULL, NULL, &pll3_sw_clk, &ssi1_ipg_clk); | ||
1311 | DEFINE_CLOCK(ssi2_ipg_clk, 1, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG10_OFFSET, | ||
1312 | NULL, NULL, &ipg_clk, NULL); | ||
1313 | DEFINE_CLOCK(ssi2_clk, 1, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG11_OFFSET, | ||
1314 | NULL, NULL, &pll3_sw_clk, &ssi2_ipg_clk); | ||
1315 | DEFINE_CLOCK(ssi3_ipg_clk, 2, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG12_OFFSET, | ||
1316 | NULL, NULL, &ipg_clk, NULL); | ||
1317 | DEFINE_CLOCK(ssi3_clk, 2, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG13_OFFSET, | ||
1318 | NULL, NULL, &pll3_sw_clk, &ssi3_ipg_clk); | ||
1319 | |||
1320 | /* eCSPI */ | ||
1321 | DEFINE_CLOCK_FULL(ecspi1_ipg_clk, 0, MXC_CCM_CCGR4, MXC_CCM_CCGRx_CG9_OFFSET, | ||
1322 | NULL, NULL, _clk_ccgr_enable_inrun, _clk_ccgr_disable, | ||
1323 | &ipg_clk, &spba_clk); | ||
1324 | DEFINE_CLOCK(ecspi1_clk, 0, MXC_CCM_CCGR4, MXC_CCM_CCGRx_CG10_OFFSET, | ||
1325 | NULL, NULL, &ecspi_main_clk, &ecspi1_ipg_clk); | ||
1326 | DEFINE_CLOCK_FULL(ecspi2_ipg_clk, 0, MXC_CCM_CCGR4, MXC_CCM_CCGRx_CG11_OFFSET, | ||
1327 | NULL, NULL, _clk_ccgr_enable_inrun, _clk_ccgr_disable, | ||
1328 | &ipg_clk, &aips_tz2_clk); | ||
1329 | DEFINE_CLOCK(ecspi2_clk, 0, MXC_CCM_CCGR4, MXC_CCM_CCGRx_CG12_OFFSET, | ||
1330 | NULL, NULL, &ecspi_main_clk, &ecspi2_ipg_clk); | ||
1331 | |||
1332 | /* CSPI */ | ||
1333 | DEFINE_CLOCK(cspi_ipg_clk, 0, MXC_CCM_CCGR4, MXC_CCM_CCGRx_CG9_OFFSET, | ||
1334 | NULL, NULL, &ipg_clk, &aips_tz2_clk); | ||
1335 | DEFINE_CLOCK(cspi_clk, 0, MXC_CCM_CCGR4, MXC_CCM_CCGRx_CG13_OFFSET, | ||
1336 | NULL, NULL, &ipg_clk, &cspi_ipg_clk); | ||
1337 | |||
1338 | /* SDMA */ | ||
1339 | DEFINE_CLOCK(sdma_clk, 1, MXC_CCM_CCGR4, MXC_CCM_CCGRx_CG15_OFFSET, | ||
1340 | NULL, NULL, &ahb_clk, NULL); | ||
1341 | |||
1342 | /* eSDHC */ | ||
1343 | DEFINE_CLOCK_FULL(esdhc1_ipg_clk, 0, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG0_OFFSET, | ||
1344 | NULL, NULL, _clk_max_enable, _clk_max_disable, &ipg_clk, NULL); | ||
1345 | DEFINE_CLOCK_MAX(esdhc1_clk, 0, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG1_OFFSET, | ||
1346 | clk_esdhc1, &pll2_sw_clk, &esdhc1_ipg_clk); | ||
1347 | DEFINE_CLOCK_FULL(esdhc2_ipg_clk, 1, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG2_OFFSET, | ||
1348 | NULL, NULL, _clk_max_enable, _clk_max_disable, &ipg_clk, NULL); | ||
1349 | DEFINE_CLOCK_FULL(esdhc3_ipg_clk, 2, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG4_OFFSET, | ||
1350 | NULL, NULL, _clk_max_enable, _clk_max_disable, &ipg_clk, NULL); | ||
1351 | DEFINE_CLOCK_FULL(esdhc4_ipg_clk, 3, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG6_OFFSET, | ||
1352 | NULL, NULL, _clk_max_enable, _clk_max_disable, &ipg_clk, NULL); | ||
1353 | |||
1354 | /* mx51 specific */ | ||
1355 | DEFINE_CLOCK_MAX(esdhc2_clk, 1, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG3_OFFSET, | ||
1356 | clk_esdhc2, &pll2_sw_clk, &esdhc2_ipg_clk); | ||
1357 | |||
1358 | static struct clk esdhc3_clk = { | ||
1359 | .id = 2, | ||
1360 | .parent = &esdhc1_clk, | ||
1361 | .set_parent = clk_esdhc3_set_parent, | ||
1362 | .enable_reg = MXC_CCM_CCGR3, | ||
1363 | .enable_shift = MXC_CCM_CCGRx_CG5_OFFSET, | ||
1364 | .enable = _clk_max_enable, | ||
1365 | .disable = _clk_max_disable, | ||
1366 | .secondary = &esdhc3_ipg_clk, | ||
1367 | }; | ||
1368 | static struct clk esdhc4_clk = { | ||
1369 | .id = 3, | ||
1370 | .parent = &esdhc1_clk, | ||
1371 | .set_parent = clk_esdhc4_set_parent, | ||
1372 | .enable_reg = MXC_CCM_CCGR3, | ||
1373 | .enable_shift = MXC_CCM_CCGRx_CG7_OFFSET, | ||
1374 | .enable = _clk_max_enable, | ||
1375 | .disable = _clk_max_disable, | ||
1376 | .secondary = &esdhc4_ipg_clk, | ||
1377 | }; | ||
1378 | |||
1379 | /* mx53 specific */ | ||
1380 | static struct clk esdhc2_mx53_clk = { | ||
1381 | .id = 2, | ||
1382 | .parent = &esdhc1_clk, | ||
1383 | .set_parent = clk_esdhc2_mx53_set_parent, | ||
1384 | .enable_reg = MXC_CCM_CCGR3, | ||
1385 | .enable_shift = MXC_CCM_CCGRx_CG3_OFFSET, | ||
1386 | .enable = _clk_max_enable, | ||
1387 | .disable = _clk_max_disable, | ||
1388 | .secondary = &esdhc3_ipg_clk, | ||
1389 | }; | ||
1390 | |||
1391 | DEFINE_CLOCK_MAX(esdhc3_mx53_clk, 2, MXC_CCM_CCGR3, MXC_CCM_CCGRx_CG5_OFFSET, | ||
1392 | clk_esdhc3_mx53, &pll2_sw_clk, &esdhc2_ipg_clk); | ||
1393 | |||
1394 | static struct clk esdhc4_mx53_clk = { | ||
1395 | .id = 3, | ||
1396 | .parent = &esdhc1_clk, | ||
1397 | .set_parent = clk_esdhc4_mx53_set_parent, | ||
1398 | .enable_reg = MXC_CCM_CCGR3, | ||
1399 | .enable_shift = MXC_CCM_CCGRx_CG7_OFFSET, | ||
1400 | .enable = _clk_max_enable, | ||
1401 | .disable = _clk_max_disable, | ||
1402 | .secondary = &esdhc4_ipg_clk, | ||
1403 | }; | ||
1404 | |||
1405 | static struct clk sata_clk = { | ||
1406 | .parent = &ipg_clk, | ||
1407 | .enable = _clk_max_enable, | ||
1408 | .enable_reg = MXC_CCM_CCGR4, | ||
1409 | .enable_shift = MXC_CCM_CCGRx_CG1_OFFSET, | ||
1410 | .disable = _clk_max_disable, | ||
1411 | }; | ||
1412 | |||
1413 | static struct clk ahci_phy_clk = { | ||
1414 | .parent = &usb_phy1_clk, | ||
1415 | }; | ||
1416 | |||
1417 | static struct clk ahci_dma_clk = { | ||
1418 | .parent = &ahb_clk, | ||
1419 | }; | ||
1420 | |||
1421 | DEFINE_CLOCK(mipi_esc_clk, 0, MXC_CCM_CCGR4, MXC_CCM_CCGRx_CG5_OFFSET, NULL, NULL, NULL, &pll2_sw_clk); | ||
1422 | DEFINE_CLOCK(mipi_hsc2_clk, 0, MXC_CCM_CCGR4, MXC_CCM_CCGRx_CG4_OFFSET, NULL, NULL, &mipi_esc_clk, &pll2_sw_clk); | ||
1423 | DEFINE_CLOCK(mipi_hsc1_clk, 0, MXC_CCM_CCGR4, MXC_CCM_CCGRx_CG3_OFFSET, NULL, NULL, &mipi_hsc2_clk, &pll2_sw_clk); | ||
1424 | |||
1425 | /* IPU */ | ||
1426 | DEFINE_CLOCK_FULL(ipu_clk, 0, MXC_CCM_CCGR5, MXC_CCM_CCGRx_CG5_OFFSET, | ||
1427 | NULL, NULL, clk_ipu_enable, clk_ipu_disable, &ahb_clk, &ipu_sec_clk); | ||
1428 | |||
1429 | DEFINE_CLOCK_FULL(emi_fast_clk, 0, MXC_CCM_CCGR5, MXC_CCM_CCGRx_CG7_OFFSET, | ||
1430 | NULL, NULL, _clk_ccgr_enable, _clk_ccgr_disable_inwait, | ||
1431 | &ddr_clk, NULL); | ||
1432 | |||
1433 | DEFINE_CLOCK(ipu_di0_clk, 0, MXC_CCM_CCGR6, MXC_CCM_CCGRx_CG5_OFFSET, | ||
1434 | NULL, NULL, &pll3_sw_clk, NULL); | ||
1435 | DEFINE_CLOCK(ipu_di1_clk, 0, MXC_CCM_CCGR6, MXC_CCM_CCGRx_CG6_OFFSET, | ||
1436 | NULL, NULL, &pll3_sw_clk, NULL); | ||
1437 | |||
1438 | /* PATA */ | ||
1439 | DEFINE_CLOCK(pata_clk, 0, MXC_CCM_CCGR4, MXC_CCM_CCGRx_CG0_OFFSET, | ||
1440 | NULL, NULL, &ipg_clk, &spba_clk); | ||
1441 | |||
1442 | #define _REGISTER_CLOCK(d, n, c) \ | ||
1443 | { \ | ||
1444 | .dev_id = d, \ | ||
1445 | .con_id = n, \ | ||
1446 | .clk = &c, \ | ||
1447 | }, | ||
1448 | |||
1449 | static struct clk_lookup mx51_lookups[] = { | ||
1450 | /* i.mx51 has the i.mx21 type uart */ | ||
1451 | _REGISTER_CLOCK("imx21-uart.0", NULL, uart1_clk) | ||
1452 | _REGISTER_CLOCK("imx21-uart.1", NULL, uart2_clk) | ||
1453 | _REGISTER_CLOCK("imx21-uart.2", NULL, uart3_clk) | ||
1454 | _REGISTER_CLOCK(NULL, "gpt", gpt_clk) | ||
1455 | /* i.mx51 has the i.mx27 type fec */ | ||
1456 | _REGISTER_CLOCK("imx27-fec.0", NULL, fec_clk) | ||
1457 | _REGISTER_CLOCK("mxc_pwm.0", "pwm", pwm1_clk) | ||
1458 | _REGISTER_CLOCK("mxc_pwm.1", "pwm", pwm2_clk) | ||
1459 | _REGISTER_CLOCK("imx-i2c.0", NULL, i2c1_clk) | ||
1460 | _REGISTER_CLOCK("imx-i2c.1", NULL, i2c2_clk) | ||
1461 | _REGISTER_CLOCK("imx-i2c.2", NULL, hsi2c_clk) | ||
1462 | _REGISTER_CLOCK("mxc-ehci.0", "usb", usboh3_clk) | ||
1463 | _REGISTER_CLOCK("mxc-ehci.0", "usb_ahb", usb_ahb_clk) | ||
1464 | _REGISTER_CLOCK("mxc-ehci.0", "usb_phy1", usb_phy1_clk) | ||
1465 | _REGISTER_CLOCK("mxc-ehci.1", "usb", usboh3_clk) | ||
1466 | _REGISTER_CLOCK("mxc-ehci.1", "usb_ahb", usb_ahb_clk) | ||
1467 | _REGISTER_CLOCK("mxc-ehci.2", "usb", usboh3_clk) | ||
1468 | _REGISTER_CLOCK("mxc-ehci.2", "usb_ahb", usb_ahb_clk) | ||
1469 | _REGISTER_CLOCK("fsl-usb2-udc", "usb", usboh3_clk) | ||
1470 | _REGISTER_CLOCK("fsl-usb2-udc", "usb_ahb", ahb_clk) | ||
1471 | _REGISTER_CLOCK("imx-keypad", NULL, dummy_clk) | ||
1472 | _REGISTER_CLOCK("mxc_nand", NULL, nfc_clk) | ||
1473 | _REGISTER_CLOCK("imx-ssi.0", NULL, ssi1_clk) | ||
1474 | _REGISTER_CLOCK("imx-ssi.1", NULL, ssi2_clk) | ||
1475 | _REGISTER_CLOCK("imx-ssi.2", NULL, ssi3_clk) | ||
1476 | /* i.mx51 has the i.mx35 type sdma */ | ||
1477 | _REGISTER_CLOCK("imx35-sdma", NULL, sdma_clk) | ||
1478 | _REGISTER_CLOCK(NULL, "ckih", ckih_clk) | ||
1479 | _REGISTER_CLOCK(NULL, "ckih2", ckih2_clk) | ||
1480 | _REGISTER_CLOCK(NULL, "gpt_32k", gpt_32k_clk) | ||
1481 | _REGISTER_CLOCK("imx51-ecspi.0", NULL, ecspi1_clk) | ||
1482 | _REGISTER_CLOCK("imx51-ecspi.1", NULL, ecspi2_clk) | ||
1483 | /* i.mx51 has the i.mx35 type cspi */ | ||
1484 | _REGISTER_CLOCK("imx35-cspi.0", NULL, cspi_clk) | ||
1485 | _REGISTER_CLOCK("sdhci-esdhc-imx51.0", NULL, esdhc1_clk) | ||
1486 | _REGISTER_CLOCK("sdhci-esdhc-imx51.1", NULL, esdhc2_clk) | ||
1487 | _REGISTER_CLOCK("sdhci-esdhc-imx51.2", NULL, esdhc3_clk) | ||
1488 | _REGISTER_CLOCK("sdhci-esdhc-imx51.3", NULL, esdhc4_clk) | ||
1489 | _REGISTER_CLOCK(NULL, "cpu_clk", cpu_clk) | ||
1490 | _REGISTER_CLOCK(NULL, "iim_clk", iim_clk) | ||
1491 | _REGISTER_CLOCK("imx2-wdt.0", NULL, dummy_clk) | ||
1492 | _REGISTER_CLOCK("imx2-wdt.1", NULL, dummy_clk) | ||
1493 | _REGISTER_CLOCK(NULL, "mipi_hsp", mipi_hsp_clk) | ||
1494 | _REGISTER_CLOCK("imx-ipuv3", NULL, ipu_clk) | ||
1495 | _REGISTER_CLOCK("imx-ipuv3", "di0", ipu_di0_clk) | ||
1496 | _REGISTER_CLOCK("imx-ipuv3", "di1", ipu_di1_clk) | ||
1497 | _REGISTER_CLOCK(NULL, "gpc_dvfs", gpc_dvfs_clk) | ||
1498 | _REGISTER_CLOCK("pata_imx", NULL, pata_clk) | ||
1499 | }; | ||
1500 | |||
1501 | static struct clk_lookup mx53_lookups[] = { | ||
1502 | /* i.mx53 has the i.mx21 type uart */ | ||
1503 | _REGISTER_CLOCK("imx21-uart.0", NULL, uart1_clk) | ||
1504 | _REGISTER_CLOCK("imx21-uart.1", NULL, uart2_clk) | ||
1505 | _REGISTER_CLOCK("imx21-uart.2", NULL, uart3_clk) | ||
1506 | _REGISTER_CLOCK("imx21-uart.3", NULL, uart4_clk) | ||
1507 | _REGISTER_CLOCK("imx21-uart.4", NULL, uart5_clk) | ||
1508 | _REGISTER_CLOCK(NULL, "gpt", gpt_clk) | ||
1509 | /* i.mx53 has the i.mx25 type fec */ | ||
1510 | _REGISTER_CLOCK("imx25-fec.0", NULL, fec_clk) | ||
1511 | _REGISTER_CLOCK(NULL, "iim_clk", iim_clk) | ||
1512 | _REGISTER_CLOCK("imx-i2c.0", NULL, i2c1_clk) | ||
1513 | _REGISTER_CLOCK("imx-i2c.1", NULL, i2c2_clk) | ||
1514 | _REGISTER_CLOCK("imx-i2c.2", NULL, i2c3_mx53_clk) | ||
1515 | /* i.mx53 has the i.mx51 type ecspi */ | ||
1516 | _REGISTER_CLOCK("imx51-ecspi.0", NULL, ecspi1_clk) | ||
1517 | _REGISTER_CLOCK("imx51-ecspi.1", NULL, ecspi2_clk) | ||
1518 | /* i.mx53 has the i.mx25 type cspi */ | ||
1519 | _REGISTER_CLOCK("imx35-cspi.0", NULL, cspi_clk) | ||
1520 | _REGISTER_CLOCK("sdhci-esdhc-imx53.0", NULL, esdhc1_clk) | ||
1521 | _REGISTER_CLOCK("sdhci-esdhc-imx53.1", NULL, esdhc2_mx53_clk) | ||
1522 | _REGISTER_CLOCK("sdhci-esdhc-imx53.2", NULL, esdhc3_mx53_clk) | ||
1523 | _REGISTER_CLOCK("sdhci-esdhc-imx53.3", NULL, esdhc4_mx53_clk) | ||
1524 | _REGISTER_CLOCK("imx2-wdt.0", NULL, dummy_clk) | ||
1525 | _REGISTER_CLOCK("imx2-wdt.1", NULL, dummy_clk) | ||
1526 | /* i.mx53 has the i.mx35 type sdma */ | ||
1527 | _REGISTER_CLOCK("imx35-sdma", NULL, sdma_clk) | ||
1528 | _REGISTER_CLOCK("imx-ssi.0", NULL, ssi1_clk) | ||
1529 | _REGISTER_CLOCK("imx-ssi.1", NULL, ssi2_clk) | ||
1530 | _REGISTER_CLOCK("imx-ssi.2", NULL, ssi3_clk) | ||
1531 | _REGISTER_CLOCK("imx-keypad", NULL, dummy_clk) | ||
1532 | _REGISTER_CLOCK("pata_imx", NULL, pata_clk) | ||
1533 | _REGISTER_CLOCK("imx53-ahci.0", "ahci", sata_clk) | ||
1534 | _REGISTER_CLOCK("imx53-ahci.0", "ahci_phy", ahci_phy_clk) | ||
1535 | _REGISTER_CLOCK("imx53-ahci.0", "ahci_dma", ahci_dma_clk) | ||
1536 | }; | ||
1537 | |||
1538 | static void clk_tree_init(void) | ||
1539 | { | ||
1540 | u32 reg; | ||
1541 | |||
1542 | ipg_perclk.set_parent(&ipg_perclk, &lp_apm_clk); | ||
1543 | |||
1544 | /* | ||
1545 | * Initialise the IPG PER CLK dividers to 3. IPG_PER_CLK should be at | ||
1546 | * 8MHz, its derived from lp_apm. | ||
1547 | * | ||
1548 | * FIXME: Verify if true for all boards | ||
1549 | */ | ||
1550 | reg = __raw_readl(MXC_CCM_CBCDR); | ||
1551 | reg &= ~MXC_CCM_CBCDR_PERCLK_PRED1_MASK; | ||
1552 | reg &= ~MXC_CCM_CBCDR_PERCLK_PRED2_MASK; | ||
1553 | reg &= ~MXC_CCM_CBCDR_PERCLK_PODF_MASK; | ||
1554 | reg |= (2 << MXC_CCM_CBCDR_PERCLK_PRED1_OFFSET); | ||
1555 | __raw_writel(reg, MXC_CCM_CBCDR); | ||
1556 | } | ||
1557 | |||
1558 | int __init mx51_clocks_init(unsigned long ckil, unsigned long osc, | ||
1559 | unsigned long ckih1, unsigned long ckih2) | ||
1560 | { | ||
1561 | int i; | ||
1562 | |||
1563 | external_low_reference = ckil; | ||
1564 | external_high_reference = ckih1; | ||
1565 | ckih2_reference = ckih2; | ||
1566 | oscillator_reference = osc; | ||
1567 | |||
1568 | for (i = 0; i < ARRAY_SIZE(mx51_lookups); i++) | ||
1569 | clkdev_add(&mx51_lookups[i]); | ||
1570 | |||
1571 | clk_tree_init(); | ||
1572 | |||
1573 | clk_enable(&cpu_clk); | ||
1574 | clk_enable(&main_bus_clk); | ||
1575 | |||
1576 | clk_enable(&iim_clk); | ||
1577 | imx_print_silicon_rev("i.MX51", mx51_revision()); | ||
1578 | clk_disable(&iim_clk); | ||
1579 | |||
1580 | /* move usb_phy_clk to 24MHz */ | ||
1581 | clk_set_parent(&usb_phy1_clk, &osc_clk); | ||
1582 | |||
1583 | /* set the usboh3_clk parent to pll2_sw_clk */ | ||
1584 | clk_set_parent(&usboh3_clk, &pll2_sw_clk); | ||
1585 | |||
1586 | /* Set SDHC parents to be PLL2 */ | ||
1587 | clk_set_parent(&esdhc1_clk, &pll2_sw_clk); | ||
1588 | clk_set_parent(&esdhc2_clk, &pll2_sw_clk); | ||
1589 | |||
1590 | /* set SDHC root clock as 166.25MHZ*/ | ||
1591 | clk_set_rate(&esdhc1_clk, 166250000); | ||
1592 | clk_set_rate(&esdhc2_clk, 166250000); | ||
1593 | |||
1594 | /* System timer */ | ||
1595 | mxc_timer_init(&gpt_clk, MX51_IO_ADDRESS(MX51_GPT1_BASE_ADDR), | ||
1596 | MX51_INT_GPT); | ||
1597 | return 0; | ||
1598 | } | ||
1599 | |||
1600 | int __init mx53_clocks_init(unsigned long ckil, unsigned long osc, | ||
1601 | unsigned long ckih1, unsigned long ckih2) | ||
1602 | { | ||
1603 | int i; | ||
1604 | |||
1605 | external_low_reference = ckil; | ||
1606 | external_high_reference = ckih1; | ||
1607 | ckih2_reference = ckih2; | ||
1608 | oscillator_reference = osc; | ||
1609 | |||
1610 | for (i = 0; i < ARRAY_SIZE(mx53_lookups); i++) | ||
1611 | clkdev_add(&mx53_lookups[i]); | ||
1612 | |||
1613 | clk_tree_init(); | ||
1614 | |||
1615 | clk_set_parent(&uart_root_clk, &pll3_sw_clk); | ||
1616 | clk_enable(&cpu_clk); | ||
1617 | clk_enable(&main_bus_clk); | ||
1618 | |||
1619 | clk_enable(&iim_clk); | ||
1620 | imx_print_silicon_rev("i.MX53", mx53_revision()); | ||
1621 | clk_disable(&iim_clk); | ||
1622 | |||
1623 | /* Set SDHC parents to be PLL2 */ | ||
1624 | clk_set_parent(&esdhc1_clk, &pll2_sw_clk); | ||
1625 | clk_set_parent(&esdhc3_mx53_clk, &pll2_sw_clk); | ||
1626 | |||
1627 | /* set SDHC root clock as 200MHZ*/ | ||
1628 | clk_set_rate(&esdhc1_clk, 200000000); | ||
1629 | clk_set_rate(&esdhc3_mx53_clk, 200000000); | ||
1630 | |||
1631 | /* System timer */ | ||
1632 | mxc_timer_init(&gpt_clk, MX53_IO_ADDRESS(MX53_GPT1_BASE_ADDR), | ||
1633 | MX53_INT_GPT); | ||
1634 | return 0; | ||
1635 | } | ||
1636 | |||
1637 | #ifdef CONFIG_OF | ||
1638 | static void __init clk_get_freq_dt(unsigned long *ckil, unsigned long *osc, | ||
1639 | unsigned long *ckih1, unsigned long *ckih2) | ||
1640 | { | ||
1641 | struct device_node *np; | ||
1642 | |||
1643 | /* retrieve the freqency of fixed clocks from device tree */ | ||
1644 | for_each_compatible_node(np, NULL, "fixed-clock") { | ||
1645 | u32 rate; | ||
1646 | if (of_property_read_u32(np, "clock-frequency", &rate)) | ||
1647 | continue; | ||
1648 | |||
1649 | if (of_device_is_compatible(np, "fsl,imx-ckil")) | ||
1650 | *ckil = rate; | ||
1651 | else if (of_device_is_compatible(np, "fsl,imx-osc")) | ||
1652 | *osc = rate; | ||
1653 | else if (of_device_is_compatible(np, "fsl,imx-ckih1")) | ||
1654 | *ckih1 = rate; | ||
1655 | else if (of_device_is_compatible(np, "fsl,imx-ckih2")) | ||
1656 | *ckih2 = rate; | ||
1657 | } | ||
1658 | } | ||
1659 | |||
1660 | int __init mx51_clocks_init_dt(void) | ||
1661 | { | ||
1662 | unsigned long ckil, osc, ckih1, ckih2; | ||
1663 | |||
1664 | clk_get_freq_dt(&ckil, &osc, &ckih1, &ckih2); | ||
1665 | return mx51_clocks_init(ckil, osc, ckih1, ckih2); | ||
1666 | } | ||
1667 | |||
1668 | int __init mx53_clocks_init_dt(void) | ||
1669 | { | ||
1670 | unsigned long ckil, osc, ckih1, ckih2; | ||
1671 | |||
1672 | clk_get_freq_dt(&ckil, &osc, &ckih1, &ckih2); | ||
1673 | return mx53_clocks_init(ckil, osc, ckih1, ckih2); | ||
1674 | } | ||
1675 | #endif | ||
diff --git a/arch/arm/mach-imx/crmregs-imx3.h b/arch/arm/mach-imx/crmregs-imx3.h index 53141273df45..a1dfde53e335 100644 --- a/arch/arm/mach-imx/crmregs-imx3.h +++ b/arch/arm/mach-imx/crmregs-imx3.h | |||
@@ -24,48 +24,47 @@ | |||
24 | #define CKIH_CLK_FREQ_27MHZ 27000000 | 24 | #define CKIH_CLK_FREQ_27MHZ 27000000 |
25 | #define CKIL_CLK_FREQ 32768 | 25 | #define CKIL_CLK_FREQ 32768 |
26 | 26 | ||
27 | #define MXC_CCM_BASE (cpu_is_mx31() ? \ | 27 | extern void __iomem *mx3_ccm_base; |
28 | MX31_IO_ADDRESS(MX31_CCM_BASE_ADDR) : MX35_IO_ADDRESS(MX35_CCM_BASE_ADDR)) | ||
29 | 28 | ||
30 | /* Register addresses */ | 29 | /* Register addresses */ |
31 | #define MXC_CCM_CCMR (MXC_CCM_BASE + 0x00) | 30 | #define MXC_CCM_CCMR 0x00 |
32 | #define MXC_CCM_PDR0 (MXC_CCM_BASE + 0x04) | 31 | #define MXC_CCM_PDR0 0x04 |
33 | #define MXC_CCM_PDR1 (MXC_CCM_BASE + 0x08) | 32 | #define MXC_CCM_PDR1 0x08 |
34 | #define MX35_CCM_PDR2 (MXC_CCM_BASE + 0x0C) | 33 | #define MX35_CCM_PDR2 0x0C |
35 | #define MXC_CCM_RCSR (MXC_CCM_BASE + 0x0C) | 34 | #define MXC_CCM_RCSR 0x0C |
36 | #define MX35_CCM_PDR3 (MXC_CCM_BASE + 0x10) | 35 | #define MX35_CCM_PDR3 0x10 |
37 | #define MXC_CCM_MPCTL (MXC_CCM_BASE + 0x10) | 36 | #define MXC_CCM_MPCTL 0x10 |
38 | #define MX35_CCM_PDR4 (MXC_CCM_BASE + 0x14) | 37 | #define MX35_CCM_PDR4 0x14 |
39 | #define MXC_CCM_UPCTL (MXC_CCM_BASE + 0x14) | 38 | #define MXC_CCM_UPCTL 0x14 |
40 | #define MX35_CCM_RCSR (MXC_CCM_BASE + 0x18) | 39 | #define MX35_CCM_RCSR 0x18 |
41 | #define MXC_CCM_SRPCTL (MXC_CCM_BASE + 0x18) | 40 | #define MXC_CCM_SRPCTL 0x18 |
42 | #define MX35_CCM_MPCTL (MXC_CCM_BASE + 0x1C) | 41 | #define MX35_CCM_MPCTL 0x1C |
43 | #define MXC_CCM_COSR (MXC_CCM_BASE + 0x1C) | 42 | #define MXC_CCM_COSR 0x1C |
44 | #define MX35_CCM_PPCTL (MXC_CCM_BASE + 0x20) | 43 | #define MX35_CCM_PPCTL 0x20 |
45 | #define MXC_CCM_CGR0 (MXC_CCM_BASE + 0x20) | 44 | #define MXC_CCM_CGR0 0x20 |
46 | #define MX35_CCM_ACMR (MXC_CCM_BASE + 0x24) | 45 | #define MX35_CCM_ACMR 0x24 |
47 | #define MXC_CCM_CGR1 (MXC_CCM_BASE + 0x24) | 46 | #define MXC_CCM_CGR1 0x24 |
48 | #define MX35_CCM_COSR (MXC_CCM_BASE + 0x28) | 47 | #define MX35_CCM_COSR 0x28 |
49 | #define MXC_CCM_CGR2 (MXC_CCM_BASE + 0x28) | 48 | #define MXC_CCM_CGR2 0x28 |
50 | #define MX35_CCM_CGR0 (MXC_CCM_BASE + 0x2C) | 49 | #define MX35_CCM_CGR0 0x2C |
51 | #define MXC_CCM_WIMR (MXC_CCM_BASE + 0x2C) | 50 | #define MXC_CCM_WIMR 0x2C |
52 | #define MX35_CCM_CGR1 (MXC_CCM_BASE + 0x30) | 51 | #define MX35_CCM_CGR1 0x30 |
53 | #define MXC_CCM_LDC (MXC_CCM_BASE + 0x30) | 52 | #define MXC_CCM_LDC 0x30 |
54 | #define MX35_CCM_CGR2 (MXC_CCM_BASE + 0x34) | 53 | #define MX35_CCM_CGR2 0x34 |
55 | #define MXC_CCM_DCVR0 (MXC_CCM_BASE + 0x34) | 54 | #define MXC_CCM_DCVR0 0x34 |
56 | #define MX35_CCM_CGR3 (MXC_CCM_BASE + 0x38) | 55 | #define MX35_CCM_CGR3 0x38 |
57 | #define MXC_CCM_DCVR1 (MXC_CCM_BASE + 0x38) | 56 | #define MXC_CCM_DCVR1 0x38 |
58 | #define MXC_CCM_DCVR2 (MXC_CCM_BASE + 0x3C) | 57 | #define MXC_CCM_DCVR2 0x3C |
59 | #define MXC_CCM_DCVR3 (MXC_CCM_BASE + 0x40) | 58 | #define MXC_CCM_DCVR3 0x40 |
60 | #define MXC_CCM_LTR0 (MXC_CCM_BASE + 0x44) | 59 | #define MXC_CCM_LTR0 0x44 |
61 | #define MXC_CCM_LTR1 (MXC_CCM_BASE + 0x48) | 60 | #define MXC_CCM_LTR1 0x48 |
62 | #define MXC_CCM_LTR2 (MXC_CCM_BASE + 0x4C) | 61 | #define MXC_CCM_LTR2 0x4C |
63 | #define MXC_CCM_LTR3 (MXC_CCM_BASE + 0x50) | 62 | #define MXC_CCM_LTR3 0x50 |
64 | #define MXC_CCM_LTBR0 (MXC_CCM_BASE + 0x54) | 63 | #define MXC_CCM_LTBR0 0x54 |
65 | #define MXC_CCM_LTBR1 (MXC_CCM_BASE + 0x58) | 64 | #define MXC_CCM_LTBR1 0x58 |
66 | #define MXC_CCM_PMCR0 (MXC_CCM_BASE + 0x5C) | 65 | #define MXC_CCM_PMCR0 0x5C |
67 | #define MXC_CCM_PMCR1 (MXC_CCM_BASE + 0x60) | 66 | #define MXC_CCM_PMCR1 0x60 |
68 | #define MXC_CCM_PDR2 (MXC_CCM_BASE + 0x64) | 67 | #define MXC_CCM_PDR2 0x64 |
69 | 68 | ||
70 | /* Register bit definitions */ | 69 | /* Register bit definitions */ |
71 | #define MXC_CCM_CCMR_WBEN (1 << 27) | 70 | #define MXC_CCM_CCMR_WBEN (1 << 27) |
diff --git a/arch/arm/mach-imx/mm-imx3.c b/arch/arm/mach-imx/mm-imx3.c index 9128d15b1eb7..967ed5b35a45 100644 --- a/arch/arm/mach-imx/mm-imx3.c +++ b/arch/arm/mach-imx/mm-imx3.c | |||
@@ -32,6 +32,10 @@ | |||
32 | #include <mach/iomux-v3.h> | 32 | #include <mach/iomux-v3.h> |
33 | #include <mach/irqs.h> | 33 | #include <mach/irqs.h> |
34 | 34 | ||
35 | #include "crmregs-imx3.h" | ||
36 | |||
37 | void __iomem *mx3_ccm_base; | ||
38 | |||
35 | static void imx3_idle(void) | 39 | static void imx3_idle(void) |
36 | { | 40 | { |
37 | unsigned long reg = 0; | 41 | unsigned long reg = 0; |
@@ -138,6 +142,7 @@ void __init imx31_init_early(void) | |||
138 | mxc_arch_reset_init(MX31_IO_ADDRESS(MX31_WDOG_BASE_ADDR)); | 142 | mxc_arch_reset_init(MX31_IO_ADDRESS(MX31_WDOG_BASE_ADDR)); |
139 | arch_ioremap_caller = imx3_ioremap_caller; | 143 | arch_ioremap_caller = imx3_ioremap_caller; |
140 | arm_pm_idle = imx3_idle; | 144 | arm_pm_idle = imx3_idle; |
145 | mx3_ccm_base = MX31_IO_ADDRESS(MX31_CCM_BASE_ADDR); | ||
141 | } | 146 | } |
142 | 147 | ||
143 | void __init mx31_init_irq(void) | 148 | void __init mx31_init_irq(void) |
@@ -211,6 +216,7 @@ void __init imx35_init_early(void) | |||
211 | mxc_arch_reset_init(MX35_IO_ADDRESS(MX35_WDOG_BASE_ADDR)); | 216 | mxc_arch_reset_init(MX35_IO_ADDRESS(MX35_WDOG_BASE_ADDR)); |
212 | arm_pm_idle = imx3_idle; | 217 | arm_pm_idle = imx3_idle; |
213 | arch_ioremap_caller = imx3_ioremap_caller; | 218 | arch_ioremap_caller = imx3_ioremap_caller; |
219 | mx3_ccm_base = MX35_IO_ADDRESS(MX35_CCM_BASE_ADDR); | ||
214 | } | 220 | } |
215 | 221 | ||
216 | void __init mx35_init_irq(void) | 222 | void __init mx35_init_irq(void) |
diff --git a/arch/arm/mach-imx/mm-imx5.c b/arch/arm/mach-imx/mm-imx5.c index ba91e6b31cf4..8b4dc20c7c53 100644 --- a/arch/arm/mach-imx/mm-imx5.c +++ b/arch/arm/mach-imx/mm-imx5.c | |||
@@ -33,6 +33,7 @@ static void imx5_idle(void) | |||
33 | gpc_dvfs_clk = clk_get(NULL, "gpc_dvfs"); | 33 | gpc_dvfs_clk = clk_get(NULL, "gpc_dvfs"); |
34 | if (IS_ERR(gpc_dvfs_clk)) | 34 | if (IS_ERR(gpc_dvfs_clk)) |
35 | return; | 35 | return; |
36 | clk_prepare(gpc_dvfs_clk); | ||
36 | } | 37 | } |
37 | clk_enable(gpc_dvfs_clk); | 38 | clk_enable(gpc_dvfs_clk); |
38 | mx5_cpu_lp_set(WAIT_UNCLOCKED_POWER_OFF); | 39 | mx5_cpu_lp_set(WAIT_UNCLOCKED_POWER_OFF); |
diff --git a/arch/arm/mach-imx/pm-imx3.c b/arch/arm/mach-imx/pm-imx3.c index b3752439632e..822103bdb709 100644 --- a/arch/arm/mach-imx/pm-imx3.c +++ b/arch/arm/mach-imx/pm-imx3.c | |||
@@ -21,14 +21,14 @@ | |||
21 | */ | 21 | */ |
22 | void mx3_cpu_lp_set(enum mx3_cpu_pwr_mode mode) | 22 | void mx3_cpu_lp_set(enum mx3_cpu_pwr_mode mode) |
23 | { | 23 | { |
24 | int reg = __raw_readl(MXC_CCM_CCMR); | 24 | int reg = __raw_readl(mx3_ccm_base + MXC_CCM_CCMR); |
25 | reg &= ~MXC_CCM_CCMR_LPM_MASK; | 25 | reg &= ~MXC_CCM_CCMR_LPM_MASK; |
26 | 26 | ||
27 | switch (mode) { | 27 | switch (mode) { |
28 | case MX3_WAIT: | 28 | case MX3_WAIT: |
29 | if (cpu_is_mx35()) | 29 | if (cpu_is_mx35()) |
30 | reg |= MXC_CCM_CCMR_LPM_WAIT_MX35; | 30 | reg |= MXC_CCM_CCMR_LPM_WAIT_MX35; |
31 | __raw_writel(reg, MXC_CCM_CCMR); | 31 | __raw_writel(reg, mx3_ccm_base + MXC_CCM_CCMR); |
32 | break; | 32 | break; |
33 | default: | 33 | default: |
34 | pr_err("Unknown cpu power mode: %d\n", mode); | 34 | pr_err("Unknown cpu power mode: %d\n", mode); |