Commit | Line | Data |
---|---|---|
a547b816 SH |
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 | ||
9ca41bcc SH |
77 | static unsigned long __clk_pllv2_recalc_rate(unsigned long parent_rate, |
78 | u32 dp_ctl, u32 dp_op, u32 dp_mfd, u32 dp_mfn) | |
a547b816 SH |
79 | { |
80 | long mfi, mfn, mfd, pdf, ref_clk, mfn_abs; | |
9ca41bcc | 81 | unsigned long dbl; |
a547b816 | 82 | s64 temp; |
a547b816 | 83 | |
a547b816 SH |
84 | dbl = dp_ctl & MXC_PLL_DP_CTL_DPDCK0_2_EN; |
85 | ||
a547b816 SH |
86 | pdf = dp_op & MXC_PLL_DP_OP_PDF_MASK; |
87 | mfi = (dp_op & MXC_PLL_DP_OP_MFI_MASK) >> MXC_PLL_DP_OP_MFI_OFFSET; | |
88 | mfi = (mfi <= 5) ? 5 : mfi; | |
89 | mfd = dp_mfd & MXC_PLL_DP_MFD_MASK; | |
90 | mfn = mfn_abs = dp_mfn & MXC_PLL_DP_MFN_MASK; | |
91 | /* Sign extend to 32-bits */ | |
92 | if (mfn >= 0x04000000) { | |
93 | mfn |= 0xFC000000; | |
94 | mfn_abs = -mfn; | |
95 | } | |
96 | ||
97 | ref_clk = 2 * parent_rate; | |
98 | if (dbl != 0) | |
99 | ref_clk *= 2; | |
100 | ||
101 | ref_clk /= (pdf + 1); | |
102 | temp = (u64) ref_clk * mfn_abs; | |
103 | do_div(temp, mfd + 1); | |
104 | if (mfn < 0) | |
105 | temp = -temp; | |
106 | temp = (ref_clk * mfi) + temp; | |
107 | ||
108 | return temp; | |
109 | } | |
110 | ||
9ca41bcc | 111 | static unsigned long clk_pllv2_recalc_rate(struct clk_hw *hw, |
a547b816 SH |
112 | unsigned long parent_rate) |
113 | { | |
9ca41bcc SH |
114 | u32 dp_op, dp_mfd, dp_mfn, dp_ctl; |
115 | void __iomem *pllbase; | |
a547b816 | 116 | struct clk_pllv2 *pll = to_clk_pllv2(hw); |
9ca41bcc SH |
117 | |
118 | pllbase = pll->base; | |
119 | ||
120 | dp_ctl = __raw_readl(pllbase + MXC_PLL_DP_CTL); | |
121 | dp_op = __raw_readl(pllbase + MXC_PLL_DP_OP); | |
122 | dp_mfd = __raw_readl(pllbase + MXC_PLL_DP_MFD); | |
123 | dp_mfn = __raw_readl(pllbase + MXC_PLL_DP_MFN); | |
124 | ||
125 | return __clk_pllv2_recalc_rate(parent_rate, dp_ctl, dp_op, dp_mfd, dp_mfn); | |
126 | } | |
127 | ||
128 | static int __clk_pllv2_set_rate(unsigned long rate, unsigned long parent_rate, | |
129 | u32 *dp_op, u32 *dp_mfd, u32 *dp_mfn) | |
130 | { | |
a547b816 | 131 | u32 reg; |
a547b816 SH |
132 | long mfi, pdf, mfn, mfd = 999999; |
133 | s64 temp64; | |
134 | unsigned long quad_parent_rate; | |
a547b816 SH |
135 | |
136 | quad_parent_rate = 4 * parent_rate; | |
137 | pdf = mfi = -1; | |
138 | while (++pdf < 16 && mfi < 5) | |
139 | mfi = rate * (pdf+1) / quad_parent_rate; | |
140 | if (mfi > 15) | |
141 | return -EINVAL; | |
142 | pdf--; | |
143 | ||
9ca41bcc SH |
144 | temp64 = rate * (pdf + 1) - quad_parent_rate * mfi; |
145 | do_div(temp64, quad_parent_rate / 1000000); | |
a547b816 SH |
146 | mfn = (long)temp64; |
147 | ||
9ca41bcc SH |
148 | reg = mfi << 4 | pdf; |
149 | ||
150 | *dp_op = reg; | |
151 | *dp_mfd = mfd; | |
152 | *dp_mfn = mfn; | |
153 | ||
154 | return 0; | |
155 | } | |
156 | ||
157 | static int clk_pllv2_set_rate(struct clk_hw *hw, unsigned long rate, | |
158 | unsigned long parent_rate) | |
159 | { | |
160 | struct clk_pllv2 *pll = to_clk_pllv2(hw); | |
161 | void __iomem *pllbase; | |
162 | u32 dp_ctl, dp_op, dp_mfd, dp_mfn; | |
163 | int ret; | |
164 | ||
165 | pllbase = pll->base; | |
166 | ||
167 | ||
168 | ret = __clk_pllv2_set_rate(rate, parent_rate, &dp_op, &dp_mfd, &dp_mfn); | |
169 | if (ret) | |
170 | return ret; | |
171 | ||
a547b816 SH |
172 | dp_ctl = __raw_readl(pllbase + MXC_PLL_DP_CTL); |
173 | /* use dpdck0_2 */ | |
174 | __raw_writel(dp_ctl | 0x1000L, pllbase + MXC_PLL_DP_CTL); | |
6cc90d6d | 175 | |
9ca41bcc SH |
176 | __raw_writel(dp_op, pllbase + MXC_PLL_DP_OP); |
177 | __raw_writel(dp_mfd, pllbase + MXC_PLL_DP_MFD); | |
178 | __raw_writel(dp_mfn, pllbase + MXC_PLL_DP_MFN); | |
a547b816 SH |
179 | |
180 | return 0; | |
181 | } | |
182 | ||
183 | static long clk_pllv2_round_rate(struct clk_hw *hw, unsigned long rate, | |
184 | unsigned long *prate) | |
185 | { | |
9ca41bcc SH |
186 | u32 dp_op, dp_mfd, dp_mfn; |
187 | ||
188 | __clk_pllv2_set_rate(rate, *prate, &dp_op, &dp_mfd, &dp_mfn); | |
189 | return __clk_pllv2_recalc_rate(*prate, MXC_PLL_DP_CTL_DPDCK0_2_EN, | |
190 | dp_op, dp_mfd, dp_mfn); | |
a547b816 SH |
191 | } |
192 | ||
193 | static int clk_pllv2_prepare(struct clk_hw *hw) | |
194 | { | |
195 | struct clk_pllv2 *pll = to_clk_pllv2(hw); | |
196 | u32 reg; | |
197 | void __iomem *pllbase; | |
198 | int i = 0; | |
199 | ||
200 | pllbase = pll->base; | |
201 | reg = __raw_readl(pllbase + MXC_PLL_DP_CTL) | MXC_PLL_DP_CTL_UPEN; | |
202 | __raw_writel(reg, pllbase + MXC_PLL_DP_CTL); | |
203 | ||
204 | /* Wait for lock */ | |
205 | do { | |
206 | reg = __raw_readl(pllbase + MXC_PLL_DP_CTL); | |
207 | if (reg & MXC_PLL_DP_CTL_LRF) | |
208 | break; | |
209 | ||
210 | udelay(1); | |
211 | } while (++i < MAX_DPLL_WAIT_TRIES); | |
212 | ||
213 | if (i == MAX_DPLL_WAIT_TRIES) { | |
214 | pr_err("MX5: pll locking failed\n"); | |
215 | return -EINVAL; | |
216 | } | |
217 | ||
218 | return 0; | |
219 | } | |
220 | ||
221 | static void clk_pllv2_unprepare(struct clk_hw *hw) | |
222 | { | |
223 | struct clk_pllv2 *pll = to_clk_pllv2(hw); | |
224 | u32 reg; | |
225 | void __iomem *pllbase; | |
226 | ||
227 | pllbase = pll->base; | |
228 | reg = __raw_readl(pllbase + MXC_PLL_DP_CTL) & ~MXC_PLL_DP_CTL_UPEN; | |
229 | __raw_writel(reg, pllbase + MXC_PLL_DP_CTL); | |
230 | } | |
231 | ||
232 | struct clk_ops clk_pllv2_ops = { | |
233 | .prepare = clk_pllv2_prepare, | |
234 | .unprepare = clk_pllv2_unprepare, | |
235 | .recalc_rate = clk_pllv2_recalc_rate, | |
236 | .round_rate = clk_pllv2_round_rate, | |
237 | .set_rate = clk_pllv2_set_rate, | |
238 | }; | |
239 | ||
240 | struct clk *imx_clk_pllv2(const char *name, const char *parent, | |
241 | void __iomem *base) | |
242 | { | |
243 | struct clk_pllv2 *pll; | |
244 | struct clk *clk; | |
245 | struct clk_init_data init; | |
246 | ||
247 | pll = kzalloc(sizeof(*pll), GFP_KERNEL); | |
248 | if (!pll) | |
249 | return ERR_PTR(-ENOMEM); | |
250 | ||
251 | pll->base = base; | |
252 | ||
253 | init.name = name; | |
254 | init.ops = &clk_pllv2_ops; | |
255 | init.flags = 0; | |
256 | init.parent_names = &parent; | |
257 | init.num_parents = 1; | |
258 | ||
259 | pll->hw.init = &init; | |
260 | ||
261 | clk = clk_register(NULL, &pll->hw); | |
262 | if (IS_ERR(clk)) | |
263 | kfree(pll); | |
264 | ||
265 | return clk; | |
266 | } |