blob: bf7397e6040f379e7c487a9154a947c8f46faded [file] [log] [blame]
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001/* Copyright (c) 2009-2011, Code Aurora Forum. All rights reserved.
2 *
3 * This program is free software; you can redistribute it and/or modify
4 * it under the terms of the GNU General Public License version 2 and
5 * only version 2 as published by the Free Software Foundation.
6 *
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
11 *
12 */
13
14#include <linux/kernel.h>
15#include <linux/init.h>
16#include <linux/err.h>
17#include <linux/ctype.h>
18#include <linux/bitops.h>
19#include <linux/io.h>
20#include <linux/spinlock.h>
21#include <linux/delay.h>
22#include <linux/clk.h>
23#include <linux/clkdev.h>
24
25#include <mach/msm_iomap.h>
26#include <mach/clk.h>
27#include <mach/msm_xo.h>
28#include <mach/scm-io.h>
29#include <mach/rpm.h>
30#include <mach/rpm-regulator.h>
31
32#include "clock-local.h"
33#include "clock-rpm.h"
34#include "clock-voter.h"
35
36#ifdef CONFIG_MSM_SECURE_IO
37#undef readl_relaxed
38#undef writel_relaxed
39#define readl_relaxed secure_readl
40#define writel_relaxed secure_writel
41#endif
42
43#define REG(off) (MSM_CLK_CTL_BASE + (off))
44#define REG_MM(off) (MSM_MMSS_CLK_CTL_BASE + (off))
45#define REG_LPA(off) (MSM_LPASS_CLK_CTL_BASE + (off))
46
47/* Peripheral clock registers. */
48#define CE2_HCLK_CTL_REG REG(0x2740)
49#define CLK_HALT_CFPB_STATEA_REG REG(0x2FCC)
50#define CLK_HALT_CFPB_STATEB_REG REG(0x2FD0)
51#define CLK_HALT_CFPB_STATEC_REG REG(0x2FD4)
52#define CLK_HALT_DFAB_STATE_REG REG(0x2FC8)
53#define CLK_HALT_MSS_SMPSS_MISC_STATE_REG REG(0x2FDC)
54#define CLK_HALT_SFPB_MISC_STATE_REG REG(0x2FD8)
55#define CLK_TEST_REG REG(0x2FA0)
56#define GSBIn_HCLK_CTL_REG(n) REG(0x29C0+(0x20*((n)-1)))
57#define GSBIn_QUP_APPS_MD_REG(n) REG(0x29C8+(0x20*((n)-1)))
58#define GSBIn_QUP_APPS_NS_REG(n) REG(0x29CC+(0x20*((n)-1)))
59#define GSBIn_RESET_REG(n) REG(0x29DC+(0x20*((n)-1)))
60#define GSBIn_UART_APPS_MD_REG(n) REG(0x29D0+(0x20*((n)-1)))
61#define GSBIn_UART_APPS_NS_REG(n) REG(0x29D4+(0x20*((n)-1)))
62#define PDM_CLK_NS_REG REG(0x2CC0)
63#define BB_PLL_ENA_SC0_REG REG(0x34C0)
64#define BB_PLL0_STATUS_REG REG(0x30D8)
65#define BB_PLL6_STATUS_REG REG(0x3118)
66#define BB_PLL8_L_VAL_REG REG(0x3144)
67#define BB_PLL8_M_VAL_REG REG(0x3148)
68#define BB_PLL8_MODE_REG REG(0x3140)
69#define BB_PLL8_N_VAL_REG REG(0x314C)
70#define BB_PLL8_STATUS_REG REG(0x3158)
71#define PLLTEST_PAD_CFG_REG REG(0x2FA4)
72#define PMEM_ACLK_CTL_REG REG(0x25A0)
73#define PPSS_HCLK_CTL_REG REG(0x2580)
74#define RINGOSC_NS_REG REG(0x2DC0)
75#define RINGOSC_STATUS_REG REG(0x2DCC)
76#define RINGOSC_TCXO_CTL_REG REG(0x2DC4)
77#define SC0_U_CLK_BRANCH_ENA_VOTE_REG REG(0x3080)
78#define SC1_U_CLK_BRANCH_ENA_VOTE_REG REG(0x30A0)
79#define SC0_U_CLK_SLEEP_ENA_VOTE_REG REG(0x3084)
80#define SC1_U_CLK_SLEEP_ENA_VOTE_REG REG(0x30A4)
81#define SDCn_APPS_CLK_MD_REG(n) REG(0x2828+(0x20*((n)-1)))
82#define SDCn_APPS_CLK_NS_REG(n) REG(0x282C+(0x20*((n)-1)))
83#define SDCn_HCLK_CTL_REG(n) REG(0x2820+(0x20*((n)-1)))
84#define SDCn_RESET_REG(n) REG(0x2830+(0x20*((n)-1)))
85#define TSIF_HCLK_CTL_REG REG(0x2700)
86#define TSIF_REF_CLK_MD_REG REG(0x270C)
87#define TSIF_REF_CLK_NS_REG REG(0x2710)
88#define TSSC_CLK_CTL_REG REG(0x2CA0)
89#define USB_FSn_HCLK_CTL_REG(n) REG(0x2960+(0x20*((n)-1)))
90#define USB_FSn_RESET_REG(n) REG(0x2974+(0x20*((n)-1)))
91#define USB_FSn_SYSTEM_CLK_CTL_REG(n) REG(0x296C+(0x20*((n)-1)))
92#define USB_FSn_XCVR_FS_CLK_MD_REG(n) REG(0x2964+(0x20*((n)-1)))
93#define USB_FSn_XCVR_FS_CLK_NS_REG(n) REG(0x2968+(0x20*((n)-1)))
94#define USB_HS1_HCLK_CTL_REG REG(0x2900)
95#define USB_HS1_RESET_REG REG(0x2910)
96#define USB_HS1_XCVR_FS_CLK_MD_REG REG(0x2908)
97#define USB_HS1_XCVR_FS_CLK_NS_REG REG(0x290C)
98#define USB_PHY0_RESET_REG REG(0x2E20)
99
100/* Multimedia clock registers. */
101#define AHB_EN_REG REG_MM(0x0008)
102#define AHB_EN2_REG REG_MM(0x0038)
103#define AHB_NS_REG REG_MM(0x0004)
104#define AXI_NS_REG REG_MM(0x0014)
105#define CAMCLK_CC_REG REG_MM(0x0140)
106#define CAMCLK_MD_REG REG_MM(0x0144)
107#define CAMCLK_NS_REG REG_MM(0x0148)
108#define CSI_CC_REG REG_MM(0x0040)
109#define CSI_NS_REG REG_MM(0x0048)
110#define DBG_BUS_VEC_A_REG REG_MM(0x01C8)
111#define DBG_BUS_VEC_B_REG REG_MM(0x01CC)
112#define DBG_BUS_VEC_C_REG REG_MM(0x01D0)
113#define DBG_BUS_VEC_D_REG REG_MM(0x01D4)
114#define DBG_BUS_VEC_E_REG REG_MM(0x01D8)
115#define DBG_BUS_VEC_F_REG REG_MM(0x01DC)
116#define DBG_BUS_VEC_H_REG REG_MM(0x01E4)
117#define DBG_CFG_REG_HS_REG REG_MM(0x01B4)
118#define DBG_CFG_REG_LS_REG REG_MM(0x01B8)
119#define GFX2D0_CC_REG REG_MM(0x0060)
120#define GFX2D0_MD0_REG REG_MM(0x0064)
121#define GFX2D0_MD1_REG REG_MM(0x0068)
122#define GFX2D0_NS_REG REG_MM(0x0070)
123#define GFX2D1_CC_REG REG_MM(0x0074)
124#define GFX2D1_MD0_REG REG_MM(0x0078)
125#define GFX2D1_MD1_REG REG_MM(0x006C)
126#define GFX2D1_NS_REG REG_MM(0x007C)
127#define GFX3D_CC_REG REG_MM(0x0080)
128#define GFX3D_MD0_REG REG_MM(0x0084)
129#define GFX3D_MD1_REG REG_MM(0x0088)
130#define GFX3D_NS_REG REG_MM(0x008C)
131#define IJPEG_CC_REG REG_MM(0x0098)
132#define IJPEG_MD_REG REG_MM(0x009C)
133#define IJPEG_NS_REG REG_MM(0x00A0)
134#define JPEGD_CC_REG REG_MM(0x00A4)
135#define JPEGD_NS_REG REG_MM(0x00AC)
136#define MAXI_EN_REG REG_MM(0x0018)
137#define MAXI_EN3_REG REG_MM(0x002C)
138#define MDP_CC_REG REG_MM(0x00C0)
139#define MDP_MD0_REG REG_MM(0x00C4)
140#define MDP_MD1_REG REG_MM(0x00C8)
141#define MDP_NS_REG REG_MM(0x00D0)
142#define MISC_CC_REG REG_MM(0x0058)
143#define MISC_CC2_REG REG_MM(0x005C)
144#define PIXEL_CC_REG REG_MM(0x00D4)
145#define PIXEL_CC2_REG REG_MM(0x0120)
146#define PIXEL_MD_REG REG_MM(0x00D8)
147#define PIXEL_NS_REG REG_MM(0x00DC)
148#define MM_PLL0_MODE_REG REG_MM(0x0300)
149#define MM_PLL1_MODE_REG REG_MM(0x031C)
150#define MM_PLL2_CONFIG_REG REG_MM(0x0348)
151#define MM_PLL2_L_VAL_REG REG_MM(0x033C)
152#define MM_PLL2_M_VAL_REG REG_MM(0x0340)
153#define MM_PLL2_MODE_REG REG_MM(0x0338)
154#define MM_PLL2_N_VAL_REG REG_MM(0x0344)
155#define ROT_CC_REG REG_MM(0x00E0)
156#define ROT_NS_REG REG_MM(0x00E8)
157#define SAXI_EN_REG REG_MM(0x0030)
158#define SW_RESET_AHB_REG REG_MM(0x020C)
159#define SW_RESET_ALL_REG REG_MM(0x0204)
160#define SW_RESET_AXI_REG REG_MM(0x0208)
161#define SW_RESET_CORE_REG REG_MM(0x0210)
162#define TV_CC_REG REG_MM(0x00EC)
163#define TV_CC2_REG REG_MM(0x0124)
164#define TV_MD_REG REG_MM(0x00F0)
165#define TV_NS_REG REG_MM(0x00F4)
166#define VCODEC_CC_REG REG_MM(0x00F8)
167#define VCODEC_MD0_REG REG_MM(0x00FC)
168#define VCODEC_MD1_REG REG_MM(0x0128)
169#define VCODEC_NS_REG REG_MM(0x0100)
170#define VFE_CC_REG REG_MM(0x0104)
171#define VFE_MD_REG REG_MM(0x0108)
172#define VFE_NS_REG REG_MM(0x010C)
173#define VPE_CC_REG REG_MM(0x0110)
174#define VPE_NS_REG REG_MM(0x0118)
175
176/* Low-power Audio clock registers. */
177#define LCC_CLK_LS_DEBUG_CFG_REG REG_LPA(0x00A8)
178#define LCC_CODEC_I2S_MIC_MD_REG REG_LPA(0x0064)
179#define LCC_CODEC_I2S_MIC_NS_REG REG_LPA(0x0060)
180#define LCC_CODEC_I2S_MIC_STATUS_REG REG_LPA(0x0068)
181#define LCC_CODEC_I2S_SPKR_MD_REG REG_LPA(0x0070)
182#define LCC_CODEC_I2S_SPKR_NS_REG REG_LPA(0x006C)
183#define LCC_CODEC_I2S_SPKR_STATUS_REG REG_LPA(0x0074)
184#define LCC_MI2S_MD_REG REG_LPA(0x004C)
185#define LCC_MI2S_NS_REG REG_LPA(0x0048)
186#define LCC_MI2S_STATUS_REG REG_LPA(0x0050)
187#define LCC_PCM_MD_REG REG_LPA(0x0058)
188#define LCC_PCM_NS_REG REG_LPA(0x0054)
189#define LCC_PCM_STATUS_REG REG_LPA(0x005C)
190#define LCC_PLL0_CONFIG_REG REG_LPA(0x0014)
191#define LCC_PLL0_L_VAL_REG REG_LPA(0x0004)
192#define LCC_PLL0_M_VAL_REG REG_LPA(0x0008)
193#define LCC_PLL0_MODE_REG REG_LPA(0x0000)
194#define LCC_PLL0_N_VAL_REG REG_LPA(0x000C)
195#define LCC_PRI_PLL_CLK_CTL_REG REG_LPA(0x00C4)
196#define LCC_SPARE_I2S_MIC_MD_REG REG_LPA(0x007C)
197#define LCC_SPARE_I2S_MIC_NS_REG REG_LPA(0x0078)
198#define LCC_SPARE_I2S_MIC_STATUS_REG REG_LPA(0x0080)
199#define LCC_SPARE_I2S_SPKR_MD_REG REG_LPA(0x0088)
200#define LCC_SPARE_I2S_SPKR_NS_REG REG_LPA(0x0084)
201#define LCC_SPARE_I2S_SPKR_STATUS_REG REG_LPA(0x008C)
202
203/* MUX source input identifiers. */
204#define pxo_to_bb_mux 0
205#define mxo_to_bb_mux 1
206#define cxo_to_bb_mux pxo_to_bb_mux
207#define pll0_to_bb_mux 2
208#define pll8_to_bb_mux 3
209#define pll6_to_bb_mux 4
210#define gnd_to_bb_mux 6
211#define pxo_to_mm_mux 0
212#define pll1_to_mm_mux 1 /* or MMSS_PLL0 */
213#define pll2_to_mm_mux 1 /* or MMSS_PLL1 */
214#define pll3_to_mm_mux 3 /* or MMSS_PLL2 */
215#define pll8_to_mm_mux 2 /* or MMSS_GPERF */
216#define pll0_to_mm_mux 3 /* or MMSS_GPLL0 */
217#define mxo_to_mm_mux 4
218#define gnd_to_mm_mux 6
219#define cxo_to_xo_mux 0
220#define pxo_to_xo_mux 1
221#define mxo_to_xo_mux 2
222#define gnd_to_xo_mux 3
223#define pxo_to_lpa_mux 0
224#define cxo_to_lpa_mux 1
225#define pll4_to_lpa_mux 2 /* or LPA_PLL0 */
226#define gnd_to_lpa_mux 6
227
228/* Test Vector Macros */
229#define TEST_TYPE_PER_LS 1
230#define TEST_TYPE_PER_HS 2
231#define TEST_TYPE_MM_LS 3
232#define TEST_TYPE_MM_HS 4
233#define TEST_TYPE_LPA 5
234#define TEST_TYPE_SC 6
235#define TEST_TYPE_MM_HS2X 7
236#define TEST_TYPE_SHIFT 24
237#define TEST_CLK_SEL_MASK BM(23, 0)
238#define TEST_VECTOR(s, t) (((t) << TEST_TYPE_SHIFT) | BVAL(23, 0, (s)))
239#define TEST_PER_LS(s) TEST_VECTOR((s), TEST_TYPE_PER_LS)
240#define TEST_PER_HS(s) TEST_VECTOR((s), TEST_TYPE_PER_HS)
241#define TEST_MM_LS(s) TEST_VECTOR((s), TEST_TYPE_MM_LS)
242#define TEST_MM_HS(s) TEST_VECTOR((s), TEST_TYPE_MM_HS)
243#define TEST_LPA(s) TEST_VECTOR((s), TEST_TYPE_LPA)
244#define TEST_SC(s) TEST_VECTOR((s), TEST_TYPE_SC)
245#define TEST_MM_HS2X(s) TEST_VECTOR((s), TEST_TYPE_MM_HS2X)
246
247struct pll_rate {
248 const uint32_t l_val;
249 const uint32_t m_val;
250 const uint32_t n_val;
251 const uint32_t vco;
252 const uint32_t post_div;
253 const uint32_t i_bits;
254};
255#define PLL_RATE(l, m, n, v, d, i) { l, m, n, v, (d>>1), i }
256/*
257 * Clock frequency definitions and macros
258 */
259#define MN_MODE_DUAL_EDGE 0x2
260
261/* MD Registers */
262#define MD4(m_lsb, m, n_lsb, n) \
263 (BVAL((m_lsb+3), m_lsb, m) | BVAL((n_lsb+3), n_lsb, ~(n)))
264#define MD8(m_lsb, m, n_lsb, n) \
265 (BVAL((m_lsb+7), m_lsb, m) | BVAL((n_lsb+7), n_lsb, ~(n)))
266#define MD16(m, n) (BVAL(31, 16, m) | BVAL(15, 0, ~(n)))
267
268/* NS Registers */
269#define NS(n_msb, n_lsb, n, m, mde_lsb, d_msb, d_lsb, d, s_msb, s_lsb, s) \
270 (BVAL(n_msb, n_lsb, ~(n-m)) \
271 | (BVAL((mde_lsb+1), mde_lsb, MN_MODE_DUAL_EDGE) * !!(n)) \
272 | BVAL(d_msb, d_lsb, (d-1)) | BVAL(s_msb, s_lsb, s))
273
274#define NS_MM(n_msb, n_lsb, n, m, d_msb, d_lsb, d, s_msb, s_lsb, s) \
275 (BVAL(n_msb, n_lsb, ~(n-m)) | BVAL(d_msb, d_lsb, (d-1)) \
276 | BVAL(s_msb, s_lsb, s))
277
278#define NS_DIVSRC(d_msb , d_lsb, d, s_msb, s_lsb, s) \
279 (BVAL(d_msb, d_lsb, (d-1)) | BVAL(s_msb, s_lsb, s))
280
281#define NS_DIV(d_msb , d_lsb, d) \
282 BVAL(d_msb, d_lsb, (d-1))
283
284#define NS_SRC_SEL(s_msb, s_lsb, s) \
285 BVAL(s_msb, s_lsb, s)
286
287#define NS_MND_BANKED4(n0_lsb, n1_lsb, n, m, s0_lsb, s1_lsb, s) \
288 (BVAL((n0_lsb+3), n0_lsb, ~(n-m)) \
289 | BVAL((n1_lsb+3), n1_lsb, ~(n-m)) \
290 | BVAL((s0_lsb+2), s0_lsb, s) \
291 | BVAL((s1_lsb+2), s1_lsb, s))
292
293#define NS_MND_BANKED8(n0_lsb, n1_lsb, n, m, s0_lsb, s1_lsb, s) \
294 (BVAL((n0_lsb+7), n0_lsb, ~(n-m)) \
295 | BVAL((n1_lsb+7), n1_lsb, ~(n-m)) \
296 | BVAL((s0_lsb+2), s0_lsb, s) \
297 | BVAL((s1_lsb+2), s1_lsb, s))
298
299#define NS_DIVSRC_BANKED(d0_msb, d0_lsb, d1_msb, d1_lsb, d, \
300 s0_msb, s0_lsb, s1_msb, s1_lsb, s) \
301 (BVAL(d0_msb, d0_lsb, (d-1)) | BVAL(d1_msb, d1_lsb, (d-1)) \
302 | BVAL(s0_msb, s0_lsb, s) \
303 | BVAL(s1_msb, s1_lsb, s))
304
305/* CC Registers */
306#define CC(mde_lsb, n) (BVAL((mde_lsb+1), mde_lsb, MN_MODE_DUAL_EDGE) * !!(n))
307#define CC_BANKED(mde0_lsb, mde1_lsb, n) \
308 ((BVAL((mde0_lsb+1), mde0_lsb, MN_MODE_DUAL_EDGE) \
309 | BVAL((mde1_lsb+1), mde1_lsb, MN_MODE_DUAL_EDGE)) \
310 * !!(n))
311
312static struct msm_xo_voter *xo_pxo, *xo_cxo;
313
314static bool xo_clk_is_local(struct clk *clk)
315{
316 return false;
317}
318
319static int pxo_clk_enable(struct clk *clk)
320{
321 return msm_xo_mode_vote(xo_pxo, MSM_XO_MODE_ON);
322}
323
324static void pxo_clk_disable(struct clk *clk)
325{
326 msm_xo_mode_vote(xo_pxo, MSM_XO_MODE_OFF);
327}
328
329static struct clk_ops clk_ops_pxo = {
330 .enable = pxo_clk_enable,
331 .disable = pxo_clk_disable,
332 .get_rate = fixed_clk_get_rate,
333 .is_local = xo_clk_is_local,
334};
335
336static struct fixed_clk pxo_clk = {
337 .rate = 27000000,
338 .c = {
339 .dbg_name = "pxo_clk",
340 .ops = &clk_ops_pxo,
341 CLK_INIT(pxo_clk.c),
342 },
343};
344
345static int cxo_clk_enable(struct clk *clk)
346{
347 return msm_xo_mode_vote(xo_cxo, MSM_XO_MODE_ON);
348}
349
350static void cxo_clk_disable(struct clk *clk)
351{
352 msm_xo_mode_vote(xo_cxo, MSM_XO_MODE_OFF);
353}
354
355static struct clk_ops clk_ops_cxo = {
356 .enable = cxo_clk_enable,
357 .disable = cxo_clk_disable,
358 .get_rate = fixed_clk_get_rate,
359 .is_local = xo_clk_is_local,
360};
361
362static struct fixed_clk cxo_clk = {
363 .rate = 19200000,
364 .c = {
365 .dbg_name = "cxo_clk",
366 .ops = &clk_ops_cxo,
367 CLK_INIT(cxo_clk.c),
368 },
369};
370
371static struct pll_vote_clk pll8_clk = {
372 .rate = 384000000,
373 .en_reg = BB_PLL_ENA_SC0_REG,
374 .en_mask = BIT(8),
375 .status_reg = BB_PLL8_STATUS_REG,
376 .parent = &pxo_clk.c,
377 .c = {
378 .dbg_name = "pll8_clk",
379 .ops = &clk_ops_pll_vote,
380 CLK_INIT(pll8_clk.c),
381 },
382};
383
384static struct pll_clk pll2_clk = {
385 .rate = 800000000,
386 .mode_reg = MM_PLL1_MODE_REG,
387 .parent = &pxo_clk.c,
388 .c = {
389 .dbg_name = "pll2_clk",
390 .ops = &clk_ops_pll,
391 CLK_INIT(pll2_clk.c),
392 },
393};
394
395static struct pll_clk pll3_clk = {
396 .rate = 0, /* TODO: Detect rate dynamically */
397 .mode_reg = MM_PLL2_MODE_REG,
398 .parent = &pxo_clk.c,
399 .c = {
400 .dbg_name = "pll3_clk",
401 .ops = &clk_ops_pll,
402 CLK_INIT(pll3_clk.c),
403 },
404};
405
406static int pll4_clk_enable(struct clk *clk)
407{
408 struct msm_rpm_iv_pair iv = { MSM_RPM_ID_PLL_4, 1 };
409 return msm_rpm_set_noirq(MSM_RPM_CTX_SET_0, &iv, 1);
410}
411
412static void pll4_clk_disable(struct clk *clk)
413{
414 struct msm_rpm_iv_pair iv = { MSM_RPM_ID_PLL_4, 0 };
415 msm_rpm_set_noirq(MSM_RPM_CTX_SET_0, &iv, 1);
416}
417
418static struct clk *pll4_clk_get_parent(struct clk *clk)
419{
420 return &pxo_clk.c;
421}
422
423static bool pll4_clk_is_local(struct clk *clk)
424{
425 return false;
426}
427
428static struct clk_ops clk_ops_pll4 = {
429 .enable = pll4_clk_enable,
430 .disable = pll4_clk_disable,
431 .get_rate = fixed_clk_get_rate,
432 .get_parent = pll4_clk_get_parent,
433 .is_local = pll4_clk_is_local,
434};
435
436static struct fixed_clk pll4_clk = {
437 .rate = 540672000,
438 .c = {
439 .dbg_name = "pll4_clk",
440 .ops = &clk_ops_pll4,
441 CLK_INIT(pll4_clk.c),
442 },
443};
444
445/*
446 * SoC-specific Set-Rate Functions
447 */
448
449/* Unlike other clocks, the TV rate is adjusted through PLL
450 * re-programming. It is also routed through an MND divider. */
451static void set_rate_tv(struct rcg_clk *clk, struct clk_freq_tbl *nf)
452{
453 struct pll_rate *rate = nf->extra_freq_data;
454 uint32_t pll_mode, pll_config, misc_cc2;
455
456 /* Disable PLL output. */
457 pll_mode = readl_relaxed(MM_PLL2_MODE_REG);
458 pll_mode &= ~BIT(0);
459 writel_relaxed(pll_mode, MM_PLL2_MODE_REG);
460
461 /* Assert active-low PLL reset. */
462 pll_mode &= ~BIT(2);
463 writel_relaxed(pll_mode, MM_PLL2_MODE_REG);
464
465 /* Program L, M and N values. */
466 writel_relaxed(rate->l_val, MM_PLL2_L_VAL_REG);
467 writel_relaxed(rate->m_val, MM_PLL2_M_VAL_REG);
468 writel_relaxed(rate->n_val, MM_PLL2_N_VAL_REG);
469
470 /* Configure MN counter, post-divide, VCO, and i-bits. */
471 pll_config = readl_relaxed(MM_PLL2_CONFIG_REG);
472 pll_config &= ~(BM(22, 20) | BM(18, 0));
473 pll_config |= rate->n_val ? BIT(22) : 0;
474 pll_config |= BVAL(21, 20, rate->post_div);
475 pll_config |= BVAL(17, 16, rate->vco);
476 pll_config |= rate->i_bits;
477 writel_relaxed(pll_config, MM_PLL2_CONFIG_REG);
478
479 /* Configure MND. */
480 set_rate_mnd(clk, nf);
481
482 /* Configure hdmi_ref_clk to be equal to the TV clock rate. */
483 misc_cc2 = readl_relaxed(MISC_CC2_REG);
484 misc_cc2 &= ~(BIT(28)|BM(21, 18));
485 misc_cc2 |= (BIT(28)|BVAL(21, 18, (nf->ns_val >> 14) & 0x3));
486 writel_relaxed(misc_cc2, MISC_CC2_REG);
487
488 /* De-assert active-low PLL reset. */
489 pll_mode |= BIT(2);
490 writel_relaxed(pll_mode, MM_PLL2_MODE_REG);
491
492 /* Enable PLL output. */
493 pll_mode |= BIT(0);
494 writel_relaxed(pll_mode, MM_PLL2_MODE_REG);
495}
496
497/*
498 * SoC-specific functions required by clock-local driver
499 */
500
501/* Update the sys_vdd voltage given a level. */
502static int msm8660_update_sys_vdd(enum sys_vdd_level level)
503{
504 static const int vdd_uv[] = {
505 [NONE] = 500000,
506 [LOW] = 1000000,
507 [NOMINAL] = 1100000,
508 [HIGH] = 1200000,
509 };
510
511 return rpm_vreg_set_voltage(RPM_VREG_ID_PM8058_S1, RPM_VREG_VOTER3,
512 vdd_uv[level], vdd_uv[HIGH], 1);
513}
514
515static int soc_clk_reset(struct clk *clk, enum clk_reset_action action)
516{
517 return branch_reset(&to_rcg_clk(clk)->b, action);
518}
519
520static struct clk_ops soc_clk_ops_8x60 = {
Matt Wagantall0625ea02011-07-13 18:51:56 -0700521 .enable = rcg_clk_enable,
522 .disable = rcg_clk_disable,
523 .auto_off = rcg_clk_auto_off,
524 .set_rate = rcg_clk_set_rate,
525 .set_min_rate = rcg_clk_set_min_rate,
526 .set_max_rate = rcg_clk_set_max_rate,
527 .get_rate = rcg_clk_get_rate,
528 .list_rate = rcg_clk_list_rate,
529 .is_enabled = rcg_clk_is_enabled,
530 .round_rate = rcg_clk_round_rate,
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700531 .reset = soc_clk_reset,
532 .is_local = local_clk_is_local,
Matt Wagantall0625ea02011-07-13 18:51:56 -0700533 .get_parent = rcg_clk_get_parent,
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700534};
535
536static struct clk_ops clk_ops_branch = {
537 .enable = branch_clk_enable,
538 .disable = branch_clk_disable,
539 .auto_off = branch_clk_auto_off,
540 .is_enabled = branch_clk_is_enabled,
541 .reset = branch_clk_reset,
542 .is_local = local_clk_is_local,
543 .get_parent = branch_clk_get_parent,
544 .set_parent = branch_clk_set_parent,
545};
546
547static struct clk_ops clk_ops_reset = {
548 .reset = branch_clk_reset,
549 .is_local = local_clk_is_local,
550};
551
552/*
553 * Clock Descriptions
554 */
555
556/* AXI Interfaces */
557static struct branch_clk gmem_axi_clk = {
558 .b = {
559 .ctl_reg = MAXI_EN_REG,
560 .en_mask = BIT(24),
561 .halt_reg = DBG_BUS_VEC_E_REG,
562 .halt_bit = 6,
563 },
564 .c = {
565 .dbg_name = "gmem_axi_clk",
566 .ops = &clk_ops_branch,
567 CLK_INIT(gmem_axi_clk.c),
568 },
569};
570
571static struct branch_clk ijpeg_axi_clk = {
572 .b = {
573 .ctl_reg = MAXI_EN_REG,
574 .en_mask = BIT(21),
575 .reset_reg = SW_RESET_AXI_REG,
576 .reset_mask = BIT(14),
577 .halt_reg = DBG_BUS_VEC_E_REG,
578 .halt_bit = 4,
579 },
580 .c = {
581 .dbg_name = "ijpeg_axi_clk",
582 .ops = &clk_ops_branch,
583 CLK_INIT(ijpeg_axi_clk.c),
584 },
585};
586
587static struct branch_clk imem_axi_clk = {
588 .b = {
589 .ctl_reg = MAXI_EN_REG,
590 .en_mask = BIT(22),
591 .reset_reg = SW_RESET_CORE_REG,
592 .reset_mask = BIT(10),
593 .halt_reg = DBG_BUS_VEC_E_REG,
594 .halt_bit = 7,
595 },
596 .c = {
597 .dbg_name = "imem_axi_clk",
598 .ops = &clk_ops_branch,
599 CLK_INIT(imem_axi_clk.c),
600 },
601};
602
603static struct branch_clk jpegd_axi_clk = {
604 .b = {
605 .ctl_reg = MAXI_EN_REG,
606 .en_mask = BIT(25),
607 .halt_reg = DBG_BUS_VEC_E_REG,
608 .halt_bit = 5,
609 },
610 .c = {
611 .dbg_name = "jpegd_axi_clk",
612 .ops = &clk_ops_branch,
613 CLK_INIT(jpegd_axi_clk.c),
614 },
615};
616
617static struct branch_clk mdp_axi_clk = {
618 .b = {
619 .ctl_reg = MAXI_EN_REG,
620 .en_mask = BIT(23),
621 .reset_reg = SW_RESET_AXI_REG,
622 .reset_mask = BIT(13),
623 .halt_reg = DBG_BUS_VEC_E_REG,
624 .halt_bit = 8,
625 },
626 .c = {
627 .dbg_name = "mdp_axi_clk",
628 .ops = &clk_ops_branch,
629 CLK_INIT(mdp_axi_clk.c),
630 },
631};
632
633static struct branch_clk vcodec_axi_clk = {
634 .b = {
635 .ctl_reg = MAXI_EN_REG,
636 .en_mask = BIT(19),
637 .reset_reg = SW_RESET_AXI_REG,
638 .reset_mask = BIT(4)|BIT(5),
639 .halt_reg = DBG_BUS_VEC_E_REG,
640 .halt_bit = 3,
641 },
642 .c = {
643 .dbg_name = "vcodec_axi_clk",
644 .ops = &clk_ops_branch,
645 CLK_INIT(vcodec_axi_clk.c),
646 },
647};
648
649static struct branch_clk vfe_axi_clk = {
650 .b = {
651 .ctl_reg = MAXI_EN_REG,
652 .en_mask = BIT(18),
653 .reset_reg = SW_RESET_AXI_REG,
654 .reset_mask = BIT(9),
655 .halt_reg = DBG_BUS_VEC_E_REG,
656 .halt_bit = 0,
657 },
658 .c = {
659 .dbg_name = "vfe_axi_clk",
660 .ops = &clk_ops_branch,
661 CLK_INIT(vfe_axi_clk.c),
662 },
663};
664
665static struct branch_clk rot_axi_clk = {
666 .b = {
667 .reset_reg = SW_RESET_AXI_REG,
668 .reset_mask = BIT(6),
669 },
670 .c = {
671 .dbg_name = "rot_axi_clk",
672 .ops = &clk_ops_reset,
673 CLK_INIT(rot_axi_clk.c),
674 },
675};
676
677static struct branch_clk vpe_axi_clk = {
678 .b = {
679 .reset_reg = SW_RESET_AXI_REG,
680 .reset_mask = BIT(15),
681 },
682 .c = {
683 .dbg_name = "vpe_axi_clk",
684 .ops = &clk_ops_reset,
685 CLK_INIT(vpe_axi_clk.c),
686 },
687};
688
689/* AHB Interfaces */
690static struct branch_clk amp_p_clk = {
691 .b = {
692 .ctl_reg = AHB_EN_REG,
693 .en_mask = BIT(24),
694 .halt_reg = DBG_BUS_VEC_F_REG,
695 .halt_bit = 18,
696 },
697 .c = {
698 .dbg_name = "amp_p_clk",
699 .ops = &clk_ops_branch,
700 CLK_INIT(amp_p_clk.c),
701 },
702};
703
704static struct branch_clk csi0_p_clk = {
705 .b = {
706 .ctl_reg = AHB_EN_REG,
707 .en_mask = BIT(7),
708 .reset_reg = SW_RESET_AHB_REG,
709 .reset_mask = BIT(17),
710 .halt_reg = DBG_BUS_VEC_F_REG,
711 .halt_bit = 16,
712 },
713 .c = {
714 .dbg_name = "csi0_p_clk",
715 .ops = &clk_ops_branch,
716 CLK_INIT(csi0_p_clk.c),
717 },
718};
719
720static struct branch_clk csi1_p_clk = {
721 .b = {
722 .ctl_reg = AHB_EN_REG,
723 .en_mask = BIT(20),
724 .reset_reg = SW_RESET_AHB_REG,
725 .reset_mask = BIT(16),
726 .halt_reg = DBG_BUS_VEC_F_REG,
727 .halt_bit = 17,
728 },
729 .c = {
730 .dbg_name = "csi1_p_clk",
731 .ops = &clk_ops_branch,
732 CLK_INIT(csi1_p_clk.c),
733 },
734};
735
736static struct branch_clk dsi_m_p_clk = {
737 .b = {
738 .ctl_reg = AHB_EN_REG,
739 .en_mask = BIT(9),
740 .reset_reg = SW_RESET_AHB_REG,
741 .reset_mask = BIT(6),
742 .halt_reg = DBG_BUS_VEC_F_REG,
743 .halt_bit = 19,
744 },
745 .c = {
746 .dbg_name = "dsi_m_p_clk",
747 .ops = &clk_ops_branch,
748 CLK_INIT(dsi_m_p_clk.c),
749 },
750};
751
752static struct branch_clk dsi_s_p_clk = {
753 .b = {
754 .ctl_reg = AHB_EN_REG,
755 .en_mask = BIT(18),
756 .reset_reg = SW_RESET_AHB_REG,
757 .reset_mask = BIT(5),
758 .halt_reg = DBG_BUS_VEC_F_REG,
759 .halt_bit = 20,
760 },
761 .c = {
762 .dbg_name = "dsi_s_p_clk",
763 .ops = &clk_ops_branch,
764 CLK_INIT(dsi_s_p_clk.c),
765 },
766};
767
768static struct branch_clk gfx2d0_p_clk = {
769 .b = {
770 .ctl_reg = AHB_EN_REG,
771 .en_mask = BIT(19),
772 .reset_reg = SW_RESET_AHB_REG,
773 .reset_mask = BIT(12),
774 .halt_reg = DBG_BUS_VEC_F_REG,
775 .halt_bit = 2,
776 },
777 .c = {
778 .dbg_name = "gfx2d0_p_clk",
779 .ops = &clk_ops_branch,
780 CLK_INIT(gfx2d0_p_clk.c),
781 },
782};
783
784static struct branch_clk gfx2d1_p_clk = {
785 .b = {
786 .ctl_reg = AHB_EN_REG,
787 .en_mask = BIT(2),
788 .reset_reg = SW_RESET_AHB_REG,
789 .reset_mask = BIT(11),
790 .halt_reg = DBG_BUS_VEC_F_REG,
791 .halt_bit = 3,
792 },
793 .c = {
794 .dbg_name = "gfx2d1_p_clk",
795 .ops = &clk_ops_branch,
796 CLK_INIT(gfx2d1_p_clk.c),
797 },
798};
799
800static struct branch_clk gfx3d_p_clk = {
801 .b = {
802 .ctl_reg = AHB_EN_REG,
803 .en_mask = BIT(3),
804 .reset_reg = SW_RESET_AHB_REG,
805 .reset_mask = BIT(10),
806 .halt_reg = DBG_BUS_VEC_F_REG,
807 .halt_bit = 4,
808 },
809 .c = {
810 .dbg_name = "gfx3d_p_clk",
811 .ops = &clk_ops_branch,
812 CLK_INIT(gfx3d_p_clk.c),
813 },
814};
815
816static struct branch_clk hdmi_m_p_clk = {
817 .b = {
818 .ctl_reg = AHB_EN_REG,
819 .en_mask = BIT(14),
820 .reset_reg = SW_RESET_AHB_REG,
821 .reset_mask = BIT(9),
822 .halt_reg = DBG_BUS_VEC_F_REG,
823 .halt_bit = 5,
824 },
825 .c = {
826 .dbg_name = "hdmi_m_p_clk",
827 .ops = &clk_ops_branch,
828 CLK_INIT(hdmi_m_p_clk.c),
829 },
830};
831
832static struct branch_clk hdmi_s_p_clk = {
833 .b = {
834 .ctl_reg = AHB_EN_REG,
835 .en_mask = BIT(4),
836 .reset_reg = SW_RESET_AHB_REG,
837 .reset_mask = BIT(9),
838 .halt_reg = DBG_BUS_VEC_F_REG,
839 .halt_bit = 6,
840 },
841 .c = {
842 .dbg_name = "hdmi_s_p_clk",
843 .ops = &clk_ops_branch,
844 CLK_INIT(hdmi_s_p_clk.c),
845 },
846};
847
848static struct branch_clk ijpeg_p_clk = {
849 .b = {
850 .ctl_reg = AHB_EN_REG,
851 .en_mask = BIT(5),
852 .reset_reg = SW_RESET_AHB_REG,
853 .reset_mask = BIT(7),
854 .halt_reg = DBG_BUS_VEC_F_REG,
855 .halt_bit = 9,
856 },
857 .c = {
858 .dbg_name = "ijpeg_p_clk",
859 .ops = &clk_ops_branch,
860 CLK_INIT(ijpeg_p_clk.c),
861 },
862};
863
864static struct branch_clk imem_p_clk = {
865 .b = {
866 .ctl_reg = AHB_EN_REG,
867 .en_mask = BIT(6),
868 .reset_reg = SW_RESET_AHB_REG,
869 .reset_mask = BIT(8),
870 .halt_reg = DBG_BUS_VEC_F_REG,
871 .halt_bit = 10,
872 },
873 .c = {
874 .dbg_name = "imem_p_clk",
875 .ops = &clk_ops_branch,
876 CLK_INIT(imem_p_clk.c),
877 },
878};
879
880static struct branch_clk jpegd_p_clk = {
881 .b = {
882 .ctl_reg = AHB_EN_REG,
883 .en_mask = BIT(21),
884 .reset_reg = SW_RESET_AHB_REG,
885 .reset_mask = BIT(4),
886 .halt_reg = DBG_BUS_VEC_F_REG,
887 .halt_bit = 7,
888 },
889 .c = {
890 .dbg_name = "jpegd_p_clk",
891 .ops = &clk_ops_branch,
892 CLK_INIT(jpegd_p_clk.c),
893 },
894};
895
896static struct branch_clk mdp_p_clk = {
897 .b = {
898 .ctl_reg = AHB_EN_REG,
899 .en_mask = BIT(10),
900 .reset_reg = SW_RESET_AHB_REG,
901 .reset_mask = BIT(3),
902 .halt_reg = DBG_BUS_VEC_F_REG,
903 .halt_bit = 11,
904 },
905 .c = {
906 .dbg_name = "mdp_p_clk",
907 .ops = &clk_ops_branch,
908 CLK_INIT(mdp_p_clk.c),
909 },
910};
911
912static struct branch_clk rot_p_clk = {
913 .b = {
914 .ctl_reg = AHB_EN_REG,
915 .en_mask = BIT(12),
916 .reset_reg = SW_RESET_AHB_REG,
917 .reset_mask = BIT(2),
918 .halt_reg = DBG_BUS_VEC_F_REG,
919 .halt_bit = 13,
920 },
921 .c = {
922 .dbg_name = "rot_p_clk",
923 .ops = &clk_ops_branch,
924 CLK_INIT(rot_p_clk.c),
925 },
926};
927
928static struct branch_clk smmu_p_clk = {
929 .b = {
930 .ctl_reg = AHB_EN_REG,
931 .en_mask = BIT(15),
932 .halt_reg = DBG_BUS_VEC_F_REG,
933 .halt_bit = 22,
934 },
935 .c = {
936 .dbg_name = "smmu_p_clk",
937 .ops = &clk_ops_branch,
938 CLK_INIT(smmu_p_clk.c),
939 },
940};
941
942static struct branch_clk tv_enc_p_clk = {
943 .b = {
944 .ctl_reg = AHB_EN_REG,
945 .en_mask = BIT(25),
946 .reset_reg = SW_RESET_AHB_REG,
947 .reset_mask = BIT(15),
948 .halt_reg = DBG_BUS_VEC_F_REG,
949 .halt_bit = 23,
950 },
951 .c = {
952 .dbg_name = "tv_enc_p_clk",
953 .ops = &clk_ops_branch,
954 CLK_INIT(tv_enc_p_clk.c),
955 },
956};
957
958static struct branch_clk vcodec_p_clk = {
959 .b = {
960 .ctl_reg = AHB_EN_REG,
961 .en_mask = BIT(11),
962 .reset_reg = SW_RESET_AHB_REG,
963 .reset_mask = BIT(1),
964 .halt_reg = DBG_BUS_VEC_F_REG,
965 .halt_bit = 12,
966 },
967 .c = {
968 .dbg_name = "vcodec_p_clk",
969 .ops = &clk_ops_branch,
970 CLK_INIT(vcodec_p_clk.c),
971 },
972};
973
974static struct branch_clk vfe_p_clk = {
975 .b = {
976 .ctl_reg = AHB_EN_REG,
977 .en_mask = BIT(13),
978 .reset_reg = SW_RESET_AHB_REG,
979 .reset_mask = BIT(0),
980 .halt_reg = DBG_BUS_VEC_F_REG,
981 .halt_bit = 14,
982 },
983 .c = {
984 .dbg_name = "vfe_p_clk",
985 .ops = &clk_ops_branch,
986 CLK_INIT(vfe_p_clk.c),
987 },
988};
989
990static struct branch_clk vpe_p_clk = {
991 .b = {
992 .ctl_reg = AHB_EN_REG,
993 .en_mask = BIT(16),
994 .reset_reg = SW_RESET_AHB_REG,
995 .reset_mask = BIT(14),
996 .halt_reg = DBG_BUS_VEC_F_REG,
997 .halt_bit = 15,
998 },
999 .c = {
1000 .dbg_name = "vpe_p_clk",
1001 .ops = &clk_ops_branch,
1002 CLK_INIT(vpe_p_clk.c),
1003 },
1004};
1005
1006/*
1007 * Peripheral Clocks
1008 */
1009#define CLK_GSBI_UART(i, n, h_r, h_b) \
1010 struct rcg_clk i##_clk = { \
1011 .b = { \
1012 .ctl_reg = GSBIn_UART_APPS_NS_REG(n), \
1013 .en_mask = BIT(9), \
1014 .reset_reg = GSBIn_RESET_REG(n), \
1015 .reset_mask = BIT(0), \
1016 .halt_reg = h_r, \
1017 .halt_bit = h_b, \
1018 }, \
1019 .ns_reg = GSBIn_UART_APPS_NS_REG(n), \
1020 .md_reg = GSBIn_UART_APPS_MD_REG(n), \
1021 .root_en_mask = BIT(11), \
1022 .ns_mask = (BM(31, 16) | BM(6, 0)), \
1023 .set_rate = set_rate_mnd, \
1024 .freq_tbl = clk_tbl_gsbi_uart, \
1025 .current_freq = &local_dummy_freq, \
1026 .c = { \
1027 .dbg_name = #i "_clk", \
1028 .ops = &soc_clk_ops_8x60, \
1029 CLK_INIT(i##_clk.c), \
1030 }, \
1031 }
1032#define F_GSBI_UART(f, s, d, m, n, v) \
1033 { \
1034 .freq_hz = f, \
1035 .src_clk = &s##_clk.c, \
1036 .md_val = MD16(m, n), \
1037 .ns_val = NS(31, 16, n, m, 5, 4, 3, d, 2, 0, s##_to_bb_mux), \
1038 .mnd_en_mask = BIT(8) * !!(n), \
1039 .sys_vdd = v, \
1040 }
1041static struct clk_freq_tbl clk_tbl_gsbi_uart[] = {
1042 F_GSBI_UART( 0, gnd, 1, 0, 0, NONE),
1043 F_GSBI_UART( 1843200, pll8, 1, 3, 625, LOW),
1044 F_GSBI_UART( 3686400, pll8, 1, 6, 625, LOW),
1045 F_GSBI_UART( 7372800, pll8, 1, 12, 625, LOW),
1046 F_GSBI_UART(14745600, pll8, 1, 24, 625, LOW),
1047 F_GSBI_UART(16000000, pll8, 4, 1, 6, LOW),
1048 F_GSBI_UART(24000000, pll8, 4, 1, 4, LOW),
1049 F_GSBI_UART(32000000, pll8, 4, 1, 3, LOW),
1050 F_GSBI_UART(40000000, pll8, 1, 5, 48, NOMINAL),
1051 F_GSBI_UART(46400000, pll8, 1, 29, 240, NOMINAL),
1052 F_GSBI_UART(48000000, pll8, 4, 1, 2, NOMINAL),
1053 F_GSBI_UART(51200000, pll8, 1, 2, 15, NOMINAL),
1054 F_GSBI_UART(56000000, pll8, 1, 7, 48, NOMINAL),
1055 F_GSBI_UART(58982400, pll8, 1, 96, 625, NOMINAL),
1056 F_GSBI_UART(64000000, pll8, 2, 1, 3, NOMINAL),
1057 F_END
1058};
1059
1060static CLK_GSBI_UART(gsbi1_uart, 1, CLK_HALT_CFPB_STATEA_REG, 10);
1061static CLK_GSBI_UART(gsbi2_uart, 2, CLK_HALT_CFPB_STATEA_REG, 6);
1062static CLK_GSBI_UART(gsbi3_uart, 3, CLK_HALT_CFPB_STATEA_REG, 2);
1063static CLK_GSBI_UART(gsbi4_uart, 4, CLK_HALT_CFPB_STATEB_REG, 26);
1064static CLK_GSBI_UART(gsbi5_uart, 5, CLK_HALT_CFPB_STATEB_REG, 22);
1065static CLK_GSBI_UART(gsbi6_uart, 6, CLK_HALT_CFPB_STATEB_REG, 18);
1066static CLK_GSBI_UART(gsbi7_uart, 7, CLK_HALT_CFPB_STATEB_REG, 14);
1067static CLK_GSBI_UART(gsbi8_uart, 8, CLK_HALT_CFPB_STATEB_REG, 10);
1068static CLK_GSBI_UART(gsbi9_uart, 9, CLK_HALT_CFPB_STATEB_REG, 6);
1069static CLK_GSBI_UART(gsbi10_uart, 10, CLK_HALT_CFPB_STATEB_REG, 2);
1070static CLK_GSBI_UART(gsbi11_uart, 11, CLK_HALT_CFPB_STATEC_REG, 17);
1071static CLK_GSBI_UART(gsbi12_uart, 12, CLK_HALT_CFPB_STATEC_REG, 13);
1072
1073#define CLK_GSBI_QUP(i, n, h_r, h_b) \
1074 struct rcg_clk i##_clk = { \
1075 .b = { \
1076 .ctl_reg = GSBIn_QUP_APPS_NS_REG(n), \
1077 .en_mask = BIT(9), \
1078 .reset_reg = GSBIn_RESET_REG(n), \
1079 .reset_mask = BIT(0), \
1080 .halt_reg = h_r, \
1081 .halt_bit = h_b, \
1082 }, \
1083 .ns_reg = GSBIn_QUP_APPS_NS_REG(n), \
1084 .md_reg = GSBIn_QUP_APPS_MD_REG(n), \
1085 .root_en_mask = BIT(11), \
1086 .ns_mask = (BM(23, 16) | BM(6, 0)), \
1087 .set_rate = set_rate_mnd, \
1088 .freq_tbl = clk_tbl_gsbi_qup, \
1089 .current_freq = &local_dummy_freq, \
1090 .c = { \
1091 .dbg_name = #i "_clk", \
1092 .ops = &soc_clk_ops_8x60, \
1093 CLK_INIT(i##_clk.c), \
1094 }, \
1095 }
1096#define F_GSBI_QUP(f, s, d, m, n, v) \
1097 { \
1098 .freq_hz = f, \
1099 .src_clk = &s##_clk.c, \
1100 .md_val = MD8(16, m, 0, n), \
1101 .ns_val = NS(23, 16, n, m, 5, 4, 3, d, 2, 0, s##_to_bb_mux), \
1102 .mnd_en_mask = BIT(8) * !!(n), \
1103 .sys_vdd = v, \
1104 }
1105static struct clk_freq_tbl clk_tbl_gsbi_qup[] = {
1106 F_GSBI_QUP( 0, gnd, 1, 0, 0, NONE),
1107 F_GSBI_QUP( 1100000, pxo, 1, 2, 49, LOW),
1108 F_GSBI_QUP( 5400000, pxo, 1, 1, 5, LOW),
1109 F_GSBI_QUP(10800000, pxo, 1, 2, 5, LOW),
1110 F_GSBI_QUP(15060000, pll8, 1, 2, 51, LOW),
1111 F_GSBI_QUP(24000000, pll8, 4, 1, 4, LOW),
1112 F_GSBI_QUP(25600000, pll8, 1, 1, 15, NOMINAL),
1113 F_GSBI_QUP(27000000, pxo, 1, 0, 0, NOMINAL),
1114 F_GSBI_QUP(48000000, pll8, 4, 1, 2, NOMINAL),
1115 F_GSBI_QUP(51200000, pll8, 1, 2, 15, NOMINAL),
1116 F_END
1117};
1118
1119static CLK_GSBI_QUP(gsbi1_qup, 1, CLK_HALT_CFPB_STATEA_REG, 9);
1120static CLK_GSBI_QUP(gsbi2_qup, 2, CLK_HALT_CFPB_STATEA_REG, 4);
1121static CLK_GSBI_QUP(gsbi3_qup, 3, CLK_HALT_CFPB_STATEA_REG, 0);
1122static CLK_GSBI_QUP(gsbi4_qup, 4, CLK_HALT_CFPB_STATEB_REG, 24);
1123static CLK_GSBI_QUP(gsbi5_qup, 5, CLK_HALT_CFPB_STATEB_REG, 20);
1124static CLK_GSBI_QUP(gsbi6_qup, 6, CLK_HALT_CFPB_STATEB_REG, 16);
1125static CLK_GSBI_QUP(gsbi7_qup, 7, CLK_HALT_CFPB_STATEB_REG, 12);
1126static CLK_GSBI_QUP(gsbi8_qup, 8, CLK_HALT_CFPB_STATEB_REG, 8);
1127static CLK_GSBI_QUP(gsbi9_qup, 9, CLK_HALT_CFPB_STATEB_REG, 4);
1128static CLK_GSBI_QUP(gsbi10_qup, 10, CLK_HALT_CFPB_STATEB_REG, 0);
1129static CLK_GSBI_QUP(gsbi11_qup, 11, CLK_HALT_CFPB_STATEC_REG, 15);
1130static CLK_GSBI_QUP(gsbi12_qup, 12, CLK_HALT_CFPB_STATEC_REG, 11);
1131
1132#define F_PDM(f, s, d, v) \
1133 { \
1134 .freq_hz = f, \
1135 .src_clk = &s##_clk.c, \
1136 .ns_val = NS_SRC_SEL(1, 0, s##_to_xo_mux), \
1137 .sys_vdd = v, \
1138 }
1139static struct clk_freq_tbl clk_tbl_pdm[] = {
1140 F_PDM( 0, gnd, 1, NONE),
1141 F_PDM(27000000, pxo, 1, LOW),
1142 F_END
1143};
1144
1145static struct rcg_clk pdm_clk = {
1146 .b = {
1147 .ctl_reg = PDM_CLK_NS_REG,
1148 .en_mask = BIT(9),
1149 .reset_reg = PDM_CLK_NS_REG,
1150 .reset_mask = BIT(12),
1151 .halt_reg = CLK_HALT_CFPB_STATEC_REG,
1152 .halt_bit = 3,
1153 },
1154 .ns_reg = PDM_CLK_NS_REG,
1155 .root_en_mask = BIT(11),
1156 .ns_mask = BM(1, 0),
1157 .set_rate = set_rate_nop,
1158 .freq_tbl = clk_tbl_pdm,
1159 .current_freq = &local_dummy_freq,
1160 .c = {
1161 .dbg_name = "pdm_clk",
1162 .ops = &soc_clk_ops_8x60,
1163 CLK_INIT(pdm_clk.c),
1164 },
1165};
1166
1167static struct branch_clk pmem_clk = {
1168 .b = {
1169 .ctl_reg = PMEM_ACLK_CTL_REG,
1170 .en_mask = BIT(4),
1171 .halt_reg = CLK_HALT_DFAB_STATE_REG,
1172 .halt_bit = 20,
1173 },
1174 .c = {
1175 .dbg_name = "pmem_clk",
1176 .ops = &clk_ops_branch,
1177 CLK_INIT(pmem_clk.c),
1178 },
1179};
1180
1181#define F_PRNG(f, s, v) \
1182 { \
1183 .freq_hz = f, \
1184 .src_clk = &s##_clk.c, \
1185 .sys_vdd = v, \
1186 }
1187static struct clk_freq_tbl clk_tbl_prng[] = {
1188 F_PRNG(64000000, pll8, NOMINAL),
1189 F_END
1190};
1191
1192static struct rcg_clk prng_clk = {
1193 .b = {
1194 .ctl_reg = SC0_U_CLK_BRANCH_ENA_VOTE_REG,
1195 .en_mask = BIT(10),
1196 .halt_reg = CLK_HALT_SFPB_MISC_STATE_REG,
1197 .halt_check = HALT_VOTED,
1198 .halt_bit = 10,
1199 },
1200 .set_rate = set_rate_nop,
1201 .freq_tbl = clk_tbl_prng,
1202 .current_freq = &local_dummy_freq,
1203 .c = {
1204 .dbg_name = "prng_clk",
1205 .ops = &soc_clk_ops_8x60,
1206 CLK_INIT(prng_clk.c),
1207 },
1208};
1209
1210#define CLK_SDC(i, n, h_r, h_b) \
1211 struct rcg_clk i##_clk = { \
1212 .b = { \
1213 .ctl_reg = SDCn_APPS_CLK_NS_REG(n), \
1214 .en_mask = BIT(9), \
1215 .reset_reg = SDCn_RESET_REG(n), \
1216 .reset_mask = BIT(0), \
1217 .halt_reg = h_r, \
1218 .halt_bit = h_b, \
1219 }, \
1220 .ns_reg = SDCn_APPS_CLK_NS_REG(n), \
1221 .md_reg = SDCn_APPS_CLK_MD_REG(n), \
1222 .root_en_mask = BIT(11), \
1223 .ns_mask = (BM(23, 16) | BM(6, 0)), \
1224 .set_rate = set_rate_mnd, \
1225 .freq_tbl = clk_tbl_sdc, \
1226 .current_freq = &local_dummy_freq, \
1227 .c = { \
1228 .dbg_name = #i "_clk", \
1229 .ops = &soc_clk_ops_8x60, \
1230 CLK_INIT(i##_clk.c), \
1231 }, \
1232 }
1233#define F_SDC(f, s, d, m, n, v) \
1234 { \
1235 .freq_hz = f, \
1236 .src_clk = &s##_clk.c, \
1237 .md_val = MD8(16, m, 0, n), \
1238 .ns_val = NS(23, 16, n, m, 5, 4, 3, d, 2, 0, s##_to_bb_mux), \
1239 .mnd_en_mask = BIT(8) * !!(n), \
1240 .sys_vdd = v, \
1241 }
1242static struct clk_freq_tbl clk_tbl_sdc[] = {
1243 F_SDC( 0, gnd, 1, 0, 0, NONE),
1244 F_SDC( 144000, pxo, 3, 2, 125, LOW),
1245 F_SDC( 400000, pll8, 4, 1, 240, LOW),
1246 F_SDC(16000000, pll8, 4, 1, 6, LOW),
1247 F_SDC(17070000, pll8, 1, 2, 45, LOW),
1248 F_SDC(20210000, pll8, 1, 1, 19, LOW),
1249 F_SDC(24000000, pll8, 4, 1, 4, LOW),
1250 F_SDC(48000000, pll8, 4, 1, 2, NOMINAL),
1251 F_END
1252};
1253
1254static CLK_SDC(sdc1, 1, CLK_HALT_DFAB_STATE_REG, 6);
1255static CLK_SDC(sdc2, 2, CLK_HALT_DFAB_STATE_REG, 5);
1256static CLK_SDC(sdc3, 3, CLK_HALT_DFAB_STATE_REG, 4);
1257static CLK_SDC(sdc4, 4, CLK_HALT_DFAB_STATE_REG, 3);
1258static CLK_SDC(sdc5, 5, CLK_HALT_DFAB_STATE_REG, 2);
1259
1260#define F_TSIF_REF(f, s, d, m, n, v) \
1261 { \
1262 .freq_hz = f, \
1263 .src_clk = &s##_clk.c, \
1264 .md_val = MD16(m, n), \
1265 .ns_val = NS(31, 16, n, m, 5, 4, 3, d, 2, 0, s##_to_bb_mux), \
1266 .mnd_en_mask = BIT(8) * !!(n), \
1267 .sys_vdd = v, \
1268 }
1269static struct clk_freq_tbl clk_tbl_tsif_ref[] = {
1270 F_TSIF_REF( 0, gnd, 1, 0, 0, NONE),
1271 F_TSIF_REF(105000, pxo, 1, 1, 256, LOW),
1272 F_END
1273};
1274
1275static struct rcg_clk tsif_ref_clk = {
1276 .b = {
1277 .ctl_reg = TSIF_REF_CLK_NS_REG,
1278 .en_mask = BIT(9),
1279 .halt_reg = CLK_HALT_CFPB_STATEC_REG,
1280 .halt_bit = 5,
1281 },
1282 .ns_reg = TSIF_REF_CLK_NS_REG,
1283 .md_reg = TSIF_REF_CLK_MD_REG,
1284 .root_en_mask = BIT(11),
1285 .ns_mask = (BM(31, 16) | BM(6, 0)),
1286 .set_rate = set_rate_mnd,
1287 .freq_tbl = clk_tbl_tsif_ref,
1288 .current_freq = &local_dummy_freq,
1289 .c = {
1290 .dbg_name = "tsif_ref_clk",
1291 .ops = &soc_clk_ops_8x60,
1292 CLK_INIT(tsif_ref_clk.c),
1293 },
1294};
1295
1296#define F_TSSC(f, s, v) \
1297 { \
1298 .freq_hz = f, \
1299 .src_clk = &s##_clk.c, \
1300 .ns_val = NS_SRC_SEL(1, 0, s##_to_xo_mux), \
1301 .sys_vdd = v, \
1302 }
1303static struct clk_freq_tbl clk_tbl_tssc[] = {
1304 F_TSSC( 0, gnd, NONE),
1305 F_TSSC(27000000, pxo, LOW),
1306 F_END
1307};
1308
1309static struct rcg_clk tssc_clk = {
1310 .b = {
1311 .ctl_reg = TSSC_CLK_CTL_REG,
1312 .en_mask = BIT(4),
1313 .halt_reg = CLK_HALT_CFPB_STATEC_REG,
1314 .halt_bit = 4,
1315 },
1316 .ns_reg = TSSC_CLK_CTL_REG,
1317 .ns_mask = BM(1, 0),
1318 .set_rate = set_rate_nop,
1319 .freq_tbl = clk_tbl_tssc,
1320 .current_freq = &local_dummy_freq,
1321 .c = {
1322 .dbg_name = "tssc_clk",
1323 .ops = &soc_clk_ops_8x60,
1324 CLK_INIT(tssc_clk.c),
1325 },
1326};
1327
1328#define F_USB(f, s, d, m, n, v) \
1329 { \
1330 .freq_hz = f, \
1331 .src_clk = &s##_clk.c, \
1332 .md_val = MD8(16, m, 0, n), \
1333 .ns_val = NS(23, 16, n, m, 5, 4, 3, d, 2, 0, s##_to_bb_mux), \
1334 .mnd_en_mask = BIT(8) * !!(n), \
1335 .sys_vdd = v, \
1336 }
1337static struct clk_freq_tbl clk_tbl_usb[] = {
1338 F_USB( 0, gnd, 1, 0, 0, NONE),
1339 F_USB(60000000, pll8, 1, 5, 32, NOMINAL),
1340 F_END
1341};
1342
1343static struct rcg_clk usb_hs1_xcvr_clk = {
1344 .b = {
1345 .ctl_reg = USB_HS1_XCVR_FS_CLK_NS_REG,
1346 .en_mask = BIT(9),
1347 .reset_reg = USB_HS1_RESET_REG,
1348 .reset_mask = BIT(0),
1349 .halt_reg = CLK_HALT_DFAB_STATE_REG,
1350 .halt_bit = 0,
1351 },
1352 .ns_reg = USB_HS1_XCVR_FS_CLK_NS_REG,
1353 .md_reg = USB_HS1_XCVR_FS_CLK_MD_REG,
1354 .root_en_mask = BIT(11),
1355 .ns_mask = (BM(23, 16) | BM(6, 0)),
1356 .set_rate = set_rate_mnd,
1357 .freq_tbl = clk_tbl_usb,
1358 .current_freq = &local_dummy_freq,
1359 .c = {
1360 .dbg_name = "usb_hs1_xcvr_clk",
1361 .ops = &soc_clk_ops_8x60,
1362 CLK_INIT(usb_hs1_xcvr_clk.c),
1363 },
1364};
1365
1366static struct branch_clk usb_phy0_clk = {
1367 .b = {
1368 .reset_reg = USB_PHY0_RESET_REG,
1369 .reset_mask = BIT(0),
1370 },
1371 .c = {
1372 .dbg_name = "usb_phy0_clk",
1373 .ops = &clk_ops_reset,
1374 CLK_INIT(usb_phy0_clk.c),
1375 },
1376};
1377
1378#define CLK_USB_FS(i, n) \
1379 struct rcg_clk i##_clk = { \
1380 .ns_reg = USB_FSn_XCVR_FS_CLK_NS_REG(n), \
1381 .b = { \
1382 .ctl_reg = USB_FSn_XCVR_FS_CLK_NS_REG(n), \
1383 .halt_check = NOCHECK, \
1384 }, \
1385 .md_reg = USB_FSn_XCVR_FS_CLK_MD_REG(n), \
1386 .root_en_mask = BIT(11), \
1387 .ns_mask = (BM(23, 16) | BM(6, 0)), \
1388 .set_rate = set_rate_mnd, \
1389 .freq_tbl = clk_tbl_usb, \
1390 .current_freq = &local_dummy_freq, \
1391 .c = { \
1392 .dbg_name = #i "_clk", \
1393 .ops = &soc_clk_ops_8x60, \
1394 CLK_INIT(i##_clk.c), \
1395 }, \
1396 }
1397
1398static CLK_USB_FS(usb_fs1_src, 1);
1399static struct branch_clk usb_fs1_xcvr_clk = {
1400 .b = {
1401 .ctl_reg = USB_FSn_XCVR_FS_CLK_NS_REG(1),
1402 .en_mask = BIT(9),
1403 .reset_reg = USB_FSn_RESET_REG(1),
1404 .reset_mask = BIT(1),
1405 .halt_reg = CLK_HALT_CFPB_STATEA_REG,
1406 .halt_bit = 15,
1407 },
1408 .parent = &usb_fs1_src_clk.c,
1409 .c = {
1410 .dbg_name = "usb_fs1_xcvr_clk",
1411 .ops = &clk_ops_branch,
1412 CLK_INIT(usb_fs1_xcvr_clk.c),
1413 },
1414};
1415
1416static struct branch_clk usb_fs1_sys_clk = {
1417 .b = {
1418 .ctl_reg = USB_FSn_SYSTEM_CLK_CTL_REG(1),
1419 .en_mask = BIT(4),
1420 .reset_reg = USB_FSn_RESET_REG(1),
1421 .reset_mask = BIT(0),
1422 .halt_reg = CLK_HALT_CFPB_STATEA_REG,
1423 .halt_bit = 16,
1424 },
1425 .parent = &usb_fs1_src_clk.c,
1426 .c = {
1427 .dbg_name = "usb_fs1_sys_clk",
1428 .ops = &clk_ops_branch,
1429 CLK_INIT(usb_fs1_sys_clk.c),
1430 },
1431};
1432
1433static CLK_USB_FS(usb_fs2_src, 2);
1434static struct branch_clk usb_fs2_xcvr_clk = {
1435 .b = {
1436 .ctl_reg = USB_FSn_XCVR_FS_CLK_NS_REG(2),
1437 .en_mask = BIT(9),
1438 .reset_reg = USB_FSn_RESET_REG(2),
1439 .reset_mask = BIT(1),
1440 .halt_reg = CLK_HALT_CFPB_STATEA_REG,
1441 .halt_bit = 12,
1442 },
1443 .parent = &usb_fs2_src_clk.c,
1444 .c = {
1445 .dbg_name = "usb_fs2_xcvr_clk",
1446 .ops = &clk_ops_branch,
1447 CLK_INIT(usb_fs2_xcvr_clk.c),
1448 },
1449};
1450
1451static struct branch_clk usb_fs2_sys_clk = {
1452 .b = {
1453 .ctl_reg = USB_FSn_SYSTEM_CLK_CTL_REG(2),
1454 .en_mask = BIT(4),
1455 .reset_reg = USB_FSn_RESET_REG(2),
1456 .reset_mask = BIT(0),
1457 .halt_reg = CLK_HALT_CFPB_STATEA_REG,
1458 .halt_bit = 13,
1459 },
1460 .parent = &usb_fs2_src_clk.c,
1461 .c = {
1462 .dbg_name = "usb_fs2_sys_clk",
1463 .ops = &clk_ops_branch,
1464 CLK_INIT(usb_fs2_sys_clk.c),
1465 },
1466};
1467
1468/* Fast Peripheral Bus Clocks */
1469static struct branch_clk ce2_p_clk = {
1470 .b = {
1471 .ctl_reg = CE2_HCLK_CTL_REG,
1472 .en_mask = BIT(4),
1473 .halt_reg = CLK_HALT_CFPB_STATEC_REG,
1474 .halt_bit = 0,
1475 },
1476 .parent = &pxo_clk.c,
1477 .c = {
1478 .dbg_name = "ce2_p_clk",
1479 .ops = &clk_ops_branch,
1480 CLK_INIT(ce2_p_clk.c),
1481 },
1482};
1483
1484static struct branch_clk gsbi1_p_clk = {
1485 .b = {
1486 .ctl_reg = GSBIn_HCLK_CTL_REG(1),
1487 .en_mask = BIT(4),
1488 .halt_reg = CLK_HALT_CFPB_STATEA_REG,
1489 .halt_bit = 11,
1490 },
1491 .c = {
1492 .dbg_name = "gsbi1_p_clk",
1493 .ops = &clk_ops_branch,
1494 CLK_INIT(gsbi1_p_clk.c),
1495 },
1496};
1497
1498static struct branch_clk gsbi2_p_clk = {
1499 .b = {
1500 .ctl_reg = GSBIn_HCLK_CTL_REG(2),
1501 .en_mask = BIT(4),
1502 .halt_reg = CLK_HALT_CFPB_STATEA_REG,
1503 .halt_bit = 7,
1504 },
1505 .c = {
1506 .dbg_name = "gsbi2_p_clk",
1507 .ops = &clk_ops_branch,
1508 CLK_INIT(gsbi2_p_clk.c),
1509 },
1510};
1511
1512static struct branch_clk gsbi3_p_clk = {
1513 .b = {
1514 .ctl_reg = GSBIn_HCLK_CTL_REG(3),
1515 .en_mask = BIT(4),
1516 .halt_reg = CLK_HALT_CFPB_STATEA_REG,
1517 .halt_bit = 3,
1518 },
1519 .c = {
1520 .dbg_name = "gsbi3_p_clk",
1521 .ops = &clk_ops_branch,
1522 CLK_INIT(gsbi3_p_clk.c),
1523 },
1524};
1525
1526static struct branch_clk gsbi4_p_clk = {
1527 .b = {
1528 .ctl_reg = GSBIn_HCLK_CTL_REG(4),
1529 .en_mask = BIT(4),
1530 .halt_reg = CLK_HALT_CFPB_STATEB_REG,
1531 .halt_bit = 27,
1532 },
1533 .c = {
1534 .dbg_name = "gsbi4_p_clk",
1535 .ops = &clk_ops_branch,
1536 CLK_INIT(gsbi4_p_clk.c),
1537 },
1538};
1539
1540static struct branch_clk gsbi5_p_clk = {
1541 .b = {
1542 .ctl_reg = GSBIn_HCLK_CTL_REG(5),
1543 .en_mask = BIT(4),
1544 .halt_reg = CLK_HALT_CFPB_STATEB_REG,
1545 .halt_bit = 23,
1546 },
1547 .c = {
1548 .dbg_name = "gsbi5_p_clk",
1549 .ops = &clk_ops_branch,
1550 CLK_INIT(gsbi5_p_clk.c),
1551 },
1552};
1553
1554static struct branch_clk gsbi6_p_clk = {
1555 .b = {
1556 .ctl_reg = GSBIn_HCLK_CTL_REG(6),
1557 .en_mask = BIT(4),
1558 .halt_reg = CLK_HALT_CFPB_STATEB_REG,
1559 .halt_bit = 19,
1560 },
1561 .c = {
1562 .dbg_name = "gsbi6_p_clk",
1563 .ops = &clk_ops_branch,
1564 CLK_INIT(gsbi6_p_clk.c),
1565 },
1566};
1567
1568static struct branch_clk gsbi7_p_clk = {
1569 .b = {
1570 .ctl_reg = GSBIn_HCLK_CTL_REG(7),
1571 .en_mask = BIT(4),
1572 .halt_reg = CLK_HALT_CFPB_STATEB_REG,
1573 .halt_bit = 15,
1574 },
1575 .c = {
1576 .dbg_name = "gsbi7_p_clk",
1577 .ops = &clk_ops_branch,
1578 CLK_INIT(gsbi7_p_clk.c),
1579 },
1580};
1581
1582static struct branch_clk gsbi8_p_clk = {
1583 .b = {
1584 .ctl_reg = GSBIn_HCLK_CTL_REG(8),
1585 .en_mask = BIT(4),
1586 .halt_reg = CLK_HALT_CFPB_STATEB_REG,
1587 .halt_bit = 11,
1588 },
1589 .c = {
1590 .dbg_name = "gsbi8_p_clk",
1591 .ops = &clk_ops_branch,
1592 CLK_INIT(gsbi8_p_clk.c),
1593 },
1594};
1595
1596static struct branch_clk gsbi9_p_clk = {
1597 .b = {
1598 .ctl_reg = GSBIn_HCLK_CTL_REG(9),
1599 .en_mask = BIT(4),
1600 .halt_reg = CLK_HALT_CFPB_STATEB_REG,
1601 .halt_bit = 7,
1602 },
1603 .c = {
1604 .dbg_name = "gsbi9_p_clk",
1605 .ops = &clk_ops_branch,
1606 CLK_INIT(gsbi9_p_clk.c),
1607 },
1608};
1609
1610static struct branch_clk gsbi10_p_clk = {
1611 .b = {
1612 .ctl_reg = GSBIn_HCLK_CTL_REG(10),
1613 .en_mask = BIT(4),
1614 .halt_reg = CLK_HALT_CFPB_STATEB_REG,
1615 .halt_bit = 3,
1616 },
1617 .c = {
1618 .dbg_name = "gsbi10_p_clk",
1619 .ops = &clk_ops_branch,
1620 CLK_INIT(gsbi10_p_clk.c),
1621 },
1622};
1623
1624static struct branch_clk gsbi11_p_clk = {
1625 .b = {
1626 .ctl_reg = GSBIn_HCLK_CTL_REG(11),
1627 .en_mask = BIT(4),
1628 .halt_reg = CLK_HALT_CFPB_STATEC_REG,
1629 .halt_bit = 18,
1630 },
1631 .c = {
1632 .dbg_name = "gsbi11_p_clk",
1633 .ops = &clk_ops_branch,
1634 CLK_INIT(gsbi11_p_clk.c),
1635 },
1636};
1637
1638static struct branch_clk gsbi12_p_clk = {
1639 .b = {
1640 .ctl_reg = GSBIn_HCLK_CTL_REG(12),
1641 .en_mask = BIT(4),
1642 .halt_reg = CLK_HALT_CFPB_STATEC_REG,
1643 .halt_bit = 14,
1644 },
1645 .c = {
1646 .dbg_name = "gsbi12_p_clk",
1647 .ops = &clk_ops_branch,
1648 CLK_INIT(gsbi12_p_clk.c),
1649 },
1650};
1651
1652static struct branch_clk ppss_p_clk = {
1653 .b = {
1654 .ctl_reg = PPSS_HCLK_CTL_REG,
1655 .en_mask = BIT(4),
1656 .halt_reg = CLK_HALT_DFAB_STATE_REG,
1657 .halt_bit = 19,
1658 },
1659 .c = {
1660 .dbg_name = "ppss_p_clk",
1661 .ops = &clk_ops_branch,
1662 CLK_INIT(ppss_p_clk.c),
1663 },
1664};
1665
1666static struct branch_clk tsif_p_clk = {
1667 .b = {
1668 .ctl_reg = TSIF_HCLK_CTL_REG,
1669 .en_mask = BIT(4),
1670 .halt_reg = CLK_HALT_CFPB_STATEC_REG,
1671 .halt_bit = 7,
1672 },
1673 .c = {
1674 .dbg_name = "tsif_p_clk",
1675 .ops = &clk_ops_branch,
1676 CLK_INIT(tsif_p_clk.c),
1677 },
1678};
1679
1680static struct branch_clk usb_fs1_p_clk = {
1681 .b = {
1682 .ctl_reg = USB_FSn_HCLK_CTL_REG(1),
1683 .en_mask = BIT(4),
1684 .halt_reg = CLK_HALT_CFPB_STATEA_REG,
1685 .halt_bit = 17,
1686 },
1687 .c = {
1688 .dbg_name = "usb_fs1_p_clk",
1689 .ops = &clk_ops_branch,
1690 CLK_INIT(usb_fs1_p_clk.c),
1691 },
1692};
1693
1694static struct branch_clk usb_fs2_p_clk = {
1695 .b = {
1696 .ctl_reg = USB_FSn_HCLK_CTL_REG(2),
1697 .en_mask = BIT(4),
1698 .halt_reg = CLK_HALT_CFPB_STATEA_REG,
1699 .halt_bit = 14,
1700 },
1701 .c = {
1702 .dbg_name = "usb_fs2_p_clk",
1703 .ops = &clk_ops_branch,
1704 CLK_INIT(usb_fs2_p_clk.c),
1705 },
1706};
1707
1708static struct branch_clk usb_hs1_p_clk = {
1709 .b = {
1710 .ctl_reg = USB_HS1_HCLK_CTL_REG,
1711 .en_mask = BIT(4),
1712 .halt_reg = CLK_HALT_DFAB_STATE_REG,
1713 .halt_bit = 1,
1714 },
1715 .c = {
1716 .dbg_name = "usb_hs1_p_clk",
1717 .ops = &clk_ops_branch,
1718 CLK_INIT(usb_hs1_p_clk.c),
1719 },
1720};
1721
1722static struct branch_clk sdc1_p_clk = {
1723 .b = {
1724 .ctl_reg = SDCn_HCLK_CTL_REG(1),
1725 .en_mask = BIT(4),
1726 .halt_reg = CLK_HALT_DFAB_STATE_REG,
1727 .halt_bit = 11,
1728 },
1729 .c = {
1730 .dbg_name = "sdc1_p_clk",
1731 .ops = &clk_ops_branch,
1732 CLK_INIT(sdc1_p_clk.c),
1733 },
1734};
1735
1736static struct branch_clk sdc2_p_clk = {
1737 .b = {
1738 .ctl_reg = SDCn_HCLK_CTL_REG(2),
1739 .en_mask = BIT(4),
1740 .halt_reg = CLK_HALT_DFAB_STATE_REG,
1741 .halt_bit = 10,
1742 },
1743 .c = {
1744 .dbg_name = "sdc2_p_clk",
1745 .ops = &clk_ops_branch,
1746 CLK_INIT(sdc2_p_clk.c),
1747 },
1748};
1749
1750static struct branch_clk sdc3_p_clk = {
1751 .b = {
1752 .ctl_reg = SDCn_HCLK_CTL_REG(3),
1753 .en_mask = BIT(4),
1754 .halt_reg = CLK_HALT_DFAB_STATE_REG,
1755 .halt_bit = 9,
1756 },
1757 .c = {
1758 .dbg_name = "sdc3_p_clk",
1759 .ops = &clk_ops_branch,
1760 CLK_INIT(sdc3_p_clk.c),
1761 },
1762};
1763
1764static struct branch_clk sdc4_p_clk = {
1765 .b = {
1766 .ctl_reg = SDCn_HCLK_CTL_REG(4),
1767 .en_mask = BIT(4),
1768 .halt_reg = CLK_HALT_DFAB_STATE_REG,
1769 .halt_bit = 8,
1770 },
1771 .c = {
1772 .dbg_name = "sdc4_p_clk",
1773 .ops = &clk_ops_branch,
1774 CLK_INIT(sdc4_p_clk.c),
1775 },
1776};
1777
1778static struct branch_clk sdc5_p_clk = {
1779 .b = {
1780 .ctl_reg = SDCn_HCLK_CTL_REG(5),
1781 .en_mask = BIT(4),
1782 .halt_reg = CLK_HALT_DFAB_STATE_REG,
1783 .halt_bit = 7,
1784 },
1785 .c = {
1786 .dbg_name = "sdc5_p_clk",
1787 .ops = &clk_ops_branch,
1788 CLK_INIT(sdc5_p_clk.c),
1789 },
1790};
1791
1792/* HW-Voteable Clocks */
1793static struct branch_clk adm0_clk = {
1794 .b = {
1795 .ctl_reg = SC0_U_CLK_BRANCH_ENA_VOTE_REG,
1796 .en_mask = BIT(2),
1797 .halt_reg = CLK_HALT_MSS_SMPSS_MISC_STATE_REG,
1798 .halt_check = HALT_VOTED,
1799 .halt_bit = 14,
1800 },
1801 .parent = &pxo_clk.c,
1802 .c = {
1803 .dbg_name = "adm0_clk",
1804 .ops = &clk_ops_branch,
1805 CLK_INIT(adm0_clk.c),
1806 },
1807};
1808
1809static struct branch_clk adm0_p_clk = {
1810 .b = {
1811 .ctl_reg = SC0_U_CLK_BRANCH_ENA_VOTE_REG,
1812 .en_mask = BIT(3),
1813 .halt_reg = CLK_HALT_MSS_SMPSS_MISC_STATE_REG,
1814 .halt_check = HALT_VOTED,
1815 .halt_bit = 13,
1816 },
1817 .c = {
1818 .dbg_name = "adm0_p_clk",
1819 .ops = &clk_ops_branch,
1820 CLK_INIT(adm0_p_clk.c),
1821 },
1822};
1823
1824static struct branch_clk adm1_clk = {
1825 .b = {
1826 .ctl_reg = SC0_U_CLK_BRANCH_ENA_VOTE_REG,
1827 .en_mask = BIT(4),
1828 .halt_reg = CLK_HALT_MSS_SMPSS_MISC_STATE_REG,
1829 .halt_check = HALT_VOTED,
1830 .halt_bit = 12,
1831 },
1832 .parent = &pxo_clk.c,
1833 .c = {
1834 .dbg_name = "adm1_clk",
1835 .ops = &clk_ops_branch,
1836 CLK_INIT(adm1_clk.c),
1837 },
1838};
1839
1840static struct branch_clk adm1_p_clk = {
1841 .b = {
1842 .ctl_reg = SC0_U_CLK_BRANCH_ENA_VOTE_REG,
1843 .en_mask = BIT(5),
1844 .halt_reg = CLK_HALT_MSS_SMPSS_MISC_STATE_REG,
1845 .halt_check = HALT_VOTED,
1846 .halt_bit = 11,
1847 },
1848 .c = {
1849 .dbg_name = "adm1_p_clk",
1850 .ops = &clk_ops_branch,
1851 CLK_INIT(adm1_p_clk.c),
1852 },
1853};
1854
1855static struct branch_clk modem_ahb1_p_clk = {
1856 .b = {
1857 .ctl_reg = SC0_U_CLK_BRANCH_ENA_VOTE_REG,
1858 .en_mask = BIT(0),
1859 .halt_reg = CLK_HALT_MSS_SMPSS_MISC_STATE_REG,
1860 .halt_check = HALT_VOTED,
1861 .halt_bit = 8,
1862 },
1863 .c = {
1864 .dbg_name = "modem_ahb1_p_clk",
1865 .ops = &clk_ops_branch,
1866 CLK_INIT(modem_ahb1_p_clk.c),
1867 },
1868};
1869
1870static struct branch_clk modem_ahb2_p_clk = {
1871 .b = {
1872 .ctl_reg = SC0_U_CLK_BRANCH_ENA_VOTE_REG,
1873 .en_mask = BIT(1),
1874 .halt_reg = CLK_HALT_MSS_SMPSS_MISC_STATE_REG,
1875 .halt_check = HALT_VOTED,
1876 .halt_bit = 7,
1877 },
1878 .c = {
1879 .dbg_name = "modem_ahb2_p_clk",
1880 .ops = &clk_ops_branch,
1881 CLK_INIT(modem_ahb2_p_clk.c),
1882 },
1883};
1884
1885static struct branch_clk pmic_arb0_p_clk = {
1886 .b = {
1887 .ctl_reg = SC0_U_CLK_BRANCH_ENA_VOTE_REG,
1888 .en_mask = BIT(8),
1889 .halt_reg = CLK_HALT_SFPB_MISC_STATE_REG,
1890 .halt_check = HALT_VOTED,
1891 .halt_bit = 22,
1892 },
1893 .c = {
1894 .dbg_name = "pmic_arb0_p_clk",
1895 .ops = &clk_ops_branch,
1896 CLK_INIT(pmic_arb0_p_clk.c),
1897 },
1898};
1899
1900static struct branch_clk pmic_arb1_p_clk = {
1901 .b = {
1902 .ctl_reg = SC0_U_CLK_BRANCH_ENA_VOTE_REG,
1903 .en_mask = BIT(9),
1904 .halt_reg = CLK_HALT_SFPB_MISC_STATE_REG,
1905 .halt_check = HALT_VOTED,
1906 .halt_bit = 21,
1907 },
1908 .c = {
1909 .dbg_name = "pmic_arb1_p_clk",
1910 .ops = &clk_ops_branch,
1911 CLK_INIT(pmic_arb1_p_clk.c),
1912 },
1913};
1914
1915static struct branch_clk pmic_ssbi2_clk = {
1916 .b = {
1917 .ctl_reg = SC0_U_CLK_BRANCH_ENA_VOTE_REG,
1918 .en_mask = BIT(7),
1919 .halt_reg = CLK_HALT_SFPB_MISC_STATE_REG,
1920 .halt_check = HALT_VOTED,
1921 .halt_bit = 23,
1922 },
1923 .c = {
1924 .dbg_name = "pmic_ssbi2_clk",
1925 .ops = &clk_ops_branch,
1926 CLK_INIT(pmic_ssbi2_clk.c),
1927 },
1928};
1929
1930static struct branch_clk rpm_msg_ram_p_clk = {
1931 .b = {
1932 .ctl_reg = SC0_U_CLK_BRANCH_ENA_VOTE_REG,
1933 .en_mask = BIT(6),
1934 .halt_reg = CLK_HALT_SFPB_MISC_STATE_REG,
1935 .halt_check = HALT_VOTED,
1936 .halt_bit = 12,
1937 },
1938 .c = {
1939 .dbg_name = "rpm_msg_ram_p_clk",
1940 .ops = &clk_ops_branch,
1941 CLK_INIT(rpm_msg_ram_p_clk.c),
1942 },
1943};
1944
1945/*
1946 * Multimedia Clocks
1947 */
1948
1949static struct branch_clk amp_clk = {
1950 .b = {
1951 .reset_reg = SW_RESET_CORE_REG,
1952 .reset_mask = BIT(20),
1953 },
1954 .c = {
1955 .dbg_name = "amp_clk",
1956 .ops = &clk_ops_reset,
1957 CLK_INIT(amp_clk.c),
1958 },
1959};
1960
1961#define F_CAM(f, s, d, m, n, v) \
1962 { \
1963 .freq_hz = f, \
1964 .src_clk = &s##_clk.c, \
1965 .md_val = MD8(8, m, 0, n), \
1966 .ns_val = NS_MM(31, 24, n, m, 15, 14, d, 2, 0, s##_to_mm_mux), \
1967 .ctl_val = CC(6, n), \
1968 .mnd_en_mask = BIT(5) * !!(n), \
1969 .sys_vdd = v, \
1970 }
1971static struct clk_freq_tbl clk_tbl_cam[] = {
1972 F_CAM( 0, gnd, 1, 0, 0, NONE),
1973 F_CAM( 6000000, pll8, 4, 1, 16, LOW),
1974 F_CAM( 8000000, pll8, 4, 1, 12, LOW),
1975 F_CAM( 12000000, pll8, 4, 1, 8, LOW),
1976 F_CAM( 16000000, pll8, 4, 1, 6, LOW),
1977 F_CAM( 19200000, pll8, 4, 1, 5, LOW),
1978 F_CAM( 24000000, pll8, 4, 1, 4, LOW),
1979 F_CAM( 32000000, pll8, 4, 1, 3, LOW),
1980 F_CAM( 48000000, pll8, 4, 1, 2, LOW),
1981 F_CAM( 64000000, pll8, 3, 1, 2, LOW),
1982 F_CAM( 96000000, pll8, 4, 0, 0, NOMINAL),
1983 F_CAM(128000000, pll8, 3, 0, 0, NOMINAL),
1984 F_END
1985};
1986
1987static struct rcg_clk cam_clk = {
1988 .b = {
1989 .ctl_reg = CAMCLK_CC_REG,
1990 .en_mask = BIT(0),
1991 .halt_check = DELAY,
1992 },
1993 .ns_reg = CAMCLK_NS_REG,
1994 .md_reg = CAMCLK_MD_REG,
1995 .root_en_mask = BIT(2),
1996 .ns_mask = (BM(31, 24) | BM(15, 14) | BM(2, 0)),
1997 .ctl_mask = BM(7, 6),
1998 .set_rate = set_rate_mnd_8,
1999 .freq_tbl = clk_tbl_cam,
2000 .current_freq = &local_dummy_freq,
2001 .c = {
2002 .dbg_name = "cam_clk",
2003 .ops = &soc_clk_ops_8x60,
2004 CLK_INIT(cam_clk.c),
2005 },
2006};
2007
2008#define F_CSI(f, s, d, v) \
2009 { \
2010 .freq_hz = f, \
2011 .src_clk = &s##_clk.c, \
2012 .ns_val = NS_DIVSRC(15, 12, d, 2, 0, s##_to_mm_mux), \
2013 .sys_vdd = v, \
2014 }
2015static struct clk_freq_tbl clk_tbl_csi[] = {
2016 F_CSI( 0, gnd, 1, NONE),
2017 F_CSI(192000000, pll8, 2, LOW),
2018 F_CSI(384000000, pll8, 1, NOMINAL),
2019 F_END
2020};
2021
2022static struct rcg_clk csi_src_clk = {
2023 .ns_reg = CSI_NS_REG,
2024 .b = {
2025 .ctl_reg = CSI_CC_REG,
2026 .halt_check = NOCHECK,
2027 },
2028 .root_en_mask = BIT(2),
2029 .ns_mask = (BM(15, 12) | BM(2, 0)),
2030 .set_rate = set_rate_nop,
2031 .freq_tbl = clk_tbl_csi,
2032 .current_freq = &local_dummy_freq,
2033 .c = {
2034 .dbg_name = "csi_src_clk",
2035 .ops = &soc_clk_ops_8x60,
2036 CLK_INIT(csi_src_clk.c),
2037 },
2038};
2039
2040static struct branch_clk csi0_clk = {
2041 .b = {
2042 .ctl_reg = CSI_CC_REG,
2043 .en_mask = BIT(0),
2044 .reset_reg = SW_RESET_CORE_REG,
2045 .reset_mask = BIT(8),
2046 .halt_reg = DBG_BUS_VEC_B_REG,
2047 .halt_bit = 13,
2048 },
2049 .parent = &csi_src_clk.c,
2050 .c = {
2051 .dbg_name = "csi0_clk",
2052 .ops = &clk_ops_branch,
2053 CLK_INIT(csi0_clk.c),
2054 },
2055};
2056
2057static struct branch_clk csi1_clk = {
2058 .b = {
2059 .ctl_reg = CSI_CC_REG,
2060 .en_mask = BIT(7),
2061 .reset_reg = SW_RESET_CORE_REG,
2062 .reset_mask = BIT(18),
2063 .halt_reg = DBG_BUS_VEC_B_REG,
2064 .halt_bit = 14,
2065 },
2066 .parent = &csi_src_clk.c,
2067 .c = {
2068 .dbg_name = "csi1_clk",
2069 .ops = &clk_ops_branch,
2070 CLK_INIT(csi1_clk.c),
2071 },
2072};
2073
2074#define F_DSI(d) \
2075 { \
2076 .freq_hz = d, \
2077 .ns_val = BVAL(27, 24, (d-1)), \
2078 }
2079/* The DSI_BYTE clock is sourced from the DSI PHY PLL, which may change rate
2080 * without this clock driver knowing. So, overload the clk_set_rate() to set
2081 * the divider (1 to 16) of the clock with respect to the PLL rate. */
2082static struct clk_freq_tbl clk_tbl_dsi_byte[] = {
2083 F_DSI(1), F_DSI(2), F_DSI(3), F_DSI(4),
2084 F_DSI(5), F_DSI(6), F_DSI(7), F_DSI(8),
2085 F_DSI(9), F_DSI(10), F_DSI(11), F_DSI(12),
2086 F_DSI(13), F_DSI(14), F_DSI(15), F_DSI(16),
2087 F_END
2088};
2089
2090
2091static struct rcg_clk dsi_byte_clk = {
2092 .b = {
2093 .ctl_reg = MISC_CC_REG,
2094 .halt_check = DELAY,
2095 .reset_reg = SW_RESET_CORE_REG,
2096 .reset_mask = BIT(7),
2097 },
2098 .ns_reg = MISC_CC2_REG,
2099 .root_en_mask = BIT(2),
2100 .ns_mask = BM(27, 24),
2101 .set_rate = set_rate_nop,
2102 .freq_tbl = clk_tbl_dsi_byte,
2103 .current_freq = &local_dummy_freq,
2104 .c = {
2105 .dbg_name = "dsi_byte_clk",
2106 .ops = &soc_clk_ops_8x60,
2107 CLK_INIT(dsi_byte_clk.c),
2108 },
2109};
2110
2111static struct branch_clk dsi_esc_clk = {
2112 .b = {
2113 .ctl_reg = MISC_CC_REG,
2114 .en_mask = BIT(0),
2115 .halt_reg = DBG_BUS_VEC_B_REG,
2116 .halt_bit = 24,
2117 },
2118 .c = {
2119 .dbg_name = "dsi_esc_clk",
2120 .ops = &clk_ops_branch,
2121 CLK_INIT(dsi_esc_clk.c),
2122 },
2123};
2124
2125#define F_GFX2D(f, s, m, n, v) \
2126 { \
2127 .freq_hz = f, \
2128 .src_clk = &s##_clk.c, \
2129 .md_val = MD4(4, m, 0, n), \
2130 .ns_val = NS_MND_BANKED4(20, 16, n, m, 3, 0, s##_to_mm_mux), \
2131 .ctl_val = CC_BANKED(9, 6, n), \
2132 .mnd_en_mask = (BIT(8) | BIT(5)) * !!(n), \
2133 .sys_vdd = v, \
2134 }
2135static struct clk_freq_tbl clk_tbl_gfx2d[] = {
2136 F_GFX2D( 0, gnd, 0, 0, NONE),
2137 F_GFX2D( 27000000, pxo, 0, 0, LOW),
2138 F_GFX2D( 48000000, pll8, 1, 8, LOW),
2139 F_GFX2D( 54857000, pll8, 1, 7, LOW),
2140 F_GFX2D( 64000000, pll8, 1, 6, LOW),
2141 F_GFX2D( 76800000, pll8, 1, 5, LOW),
2142 F_GFX2D( 96000000, pll8, 1, 4, LOW),
2143 F_GFX2D(128000000, pll8, 1, 3, NOMINAL),
2144 F_GFX2D(145455000, pll2, 2, 11, NOMINAL),
2145 F_GFX2D(160000000, pll2, 1, 5, NOMINAL),
2146 F_GFX2D(177778000, pll2, 2, 9, NOMINAL),
2147 F_GFX2D(200000000, pll2, 1, 4, NOMINAL),
2148 F_GFX2D(228571000, pll2, 2, 7, HIGH),
2149 F_END
2150};
2151
2152static struct bank_masks bmnd_info_gfx2d0 = {
2153 .bank_sel_mask = BIT(11),
2154 .bank0_mask = {
2155 .md_reg = GFX2D0_MD0_REG,
2156 .ns_mask = BM(23, 20) | BM(5, 3),
2157 .rst_mask = BIT(25),
2158 .mnd_en_mask = BIT(8),
2159 .mode_mask = BM(10, 9),
2160 },
2161 .bank1_mask = {
2162 .md_reg = GFX2D0_MD1_REG,
2163 .ns_mask = BM(19, 16) | BM(2, 0),
2164 .rst_mask = BIT(24),
2165 .mnd_en_mask = BIT(5),
2166 .mode_mask = BM(7, 6),
2167 },
2168};
2169
2170static struct rcg_clk gfx2d0_clk = {
2171 .b = {
2172 .ctl_reg = GFX2D0_CC_REG,
2173 .en_mask = BIT(0),
2174 .reset_reg = SW_RESET_CORE_REG,
2175 .reset_mask = BIT(14),
2176 .halt_reg = DBG_BUS_VEC_A_REG,
2177 .halt_bit = 9,
2178 },
2179 .ns_reg = GFX2D0_NS_REG,
2180 .root_en_mask = BIT(2),
2181 .set_rate = set_rate_mnd_banked,
2182 .freq_tbl = clk_tbl_gfx2d,
2183 .bank_masks = &bmnd_info_gfx2d0,
2184 .current_freq = &local_dummy_freq,
2185 .c = {
2186 .dbg_name = "gfx2d0_clk",
2187 .ops = &soc_clk_ops_8x60,
2188 CLK_INIT(gfx2d0_clk.c),
2189 },
2190};
2191
2192static struct bank_masks bmnd_info_gfx2d1 = {
2193 .bank_sel_mask = BIT(11),
2194 .bank0_mask = {
2195 .md_reg = GFX2D1_MD0_REG,
2196 .ns_mask = BM(23, 20) | BM(5, 3),
2197 .rst_mask = BIT(25),
2198 .mnd_en_mask = BIT(8),
2199 .mode_mask = BM(10, 9),
2200 },
2201 .bank1_mask = {
2202 .md_reg = GFX2D1_MD1_REG,
2203 .ns_mask = BM(19, 16) | BM(2, 0),
2204 .rst_mask = BIT(24),
2205 .mnd_en_mask = BIT(5),
2206 .mode_mask = BM(7, 6),
2207 },
2208};
2209
2210static struct rcg_clk gfx2d1_clk = {
2211 .b = {
2212 .ctl_reg = GFX2D1_CC_REG,
2213 .en_mask = BIT(0),
2214 .reset_reg = SW_RESET_CORE_REG,
2215 .reset_mask = BIT(13),
2216 .halt_reg = DBG_BUS_VEC_A_REG,
2217 .halt_bit = 14,
2218 },
2219 .ns_reg = GFX2D1_NS_REG,
2220 .root_en_mask = BIT(2),
2221 .set_rate = set_rate_mnd_banked,
2222 .freq_tbl = clk_tbl_gfx2d,
2223 .bank_masks = &bmnd_info_gfx2d1,
2224 .current_freq = &local_dummy_freq,
2225 .c = {
2226 .dbg_name = "gfx2d1_clk",
2227 .ops = &soc_clk_ops_8x60,
2228 CLK_INIT(gfx2d1_clk.c),
2229 },
2230};
2231
2232#define F_GFX3D(f, s, m, n, v) \
2233 { \
2234 .freq_hz = f, \
2235 .src_clk = &s##_clk.c, \
2236 .md_val = MD4(4, m, 0, n), \
2237 .ns_val = NS_MND_BANKED4(18, 14, n, m, 3, 0, s##_to_mm_mux), \
2238 .ctl_val = CC_BANKED(9, 6, n), \
2239 .mnd_en_mask = (BIT(8) | BIT(5)) * !!(n), \
2240 .sys_vdd = v, \
2241 }
2242static struct clk_freq_tbl clk_tbl_gfx3d[] = {
2243 F_GFX3D( 0, gnd, 0, 0, NONE),
2244 F_GFX3D( 27000000, pxo, 0, 0, LOW),
2245 F_GFX3D( 48000000, pll8, 1, 8, LOW),
2246 F_GFX3D( 54857000, pll8, 1, 7, LOW),
2247 F_GFX3D( 64000000, pll8, 1, 6, LOW),
2248 F_GFX3D( 76800000, pll8, 1, 5, LOW),
2249 F_GFX3D( 96000000, pll8, 1, 4, LOW),
2250 F_GFX3D(128000000, pll8, 1, 3, NOMINAL),
2251 F_GFX3D(145455000, pll2, 2, 11, NOMINAL),
2252 F_GFX3D(160000000, pll2, 1, 5, NOMINAL),
2253 F_GFX3D(177778000, pll2, 2, 9, NOMINAL),
2254 F_GFX3D(200000000, pll2, 1, 4, NOMINAL),
2255 F_GFX3D(228571000, pll2, 2, 7, HIGH),
2256 F_GFX3D(266667000, pll2, 1, 3, HIGH),
2257 F_GFX3D(320000000, pll2, 2, 5, HIGH),
2258 F_END
2259};
2260
2261static struct bank_masks bmnd_info_gfx3d = {
2262 .bank_sel_mask = BIT(11),
2263 .bank0_mask = {
2264 .md_reg = GFX3D_MD0_REG,
2265 .ns_mask = BM(21, 18) | BM(5, 3),
2266 .rst_mask = BIT(23),
2267 .mnd_en_mask = BIT(8),
2268 .mode_mask = BM(10, 9),
2269 },
2270 .bank1_mask = {
2271 .md_reg = GFX3D_MD1_REG,
2272 .ns_mask = BM(17, 14) | BM(2, 0),
2273 .rst_mask = BIT(22),
2274 .mnd_en_mask = BIT(5),
2275 .mode_mask = BM(7, 6),
2276 },
2277};
2278
2279static struct rcg_clk gfx3d_clk = {
2280 .b = {
2281 .ctl_reg = GFX3D_CC_REG,
2282 .en_mask = BIT(0),
2283 .reset_reg = SW_RESET_CORE_REG,
2284 .reset_mask = BIT(12),
2285 .halt_reg = DBG_BUS_VEC_A_REG,
2286 .halt_bit = 4,
2287 },
2288 .ns_reg = GFX3D_NS_REG,
2289 .root_en_mask = BIT(2),
2290 .set_rate = set_rate_mnd_banked,
2291 .freq_tbl = clk_tbl_gfx3d,
2292 .bank_masks = &bmnd_info_gfx3d,
2293 .depends = &gmem_axi_clk.c,
2294 .current_freq = &local_dummy_freq,
2295 .c = {
2296 .dbg_name = "gfx3d_clk",
2297 .ops = &soc_clk_ops_8x60,
2298 CLK_INIT(gfx3d_clk.c),
2299 },
2300};
2301
2302#define F_IJPEG(f, s, d, m, n, v) \
2303 { \
2304 .freq_hz = f, \
2305 .src_clk = &s##_clk.c, \
2306 .md_val = MD8(8, m, 0, n), \
2307 .ns_val = NS_MM(23, 16, n, m, 15, 12, d, 2, 0, s##_to_mm_mux), \
2308 .ctl_val = CC(6, n), \
2309 .mnd_en_mask = BIT(5) * !!n, \
2310 .sys_vdd = v, \
2311 }
2312static struct clk_freq_tbl clk_tbl_ijpeg[] = {
2313 F_IJPEG( 0, gnd, 1, 0, 0, NONE),
2314 F_IJPEG( 27000000, pxo, 1, 0, 0, LOW),
2315 F_IJPEG( 36570000, pll8, 1, 2, 21, LOW),
2316 F_IJPEG( 54860000, pll8, 7, 0, 0, LOW),
2317 F_IJPEG( 96000000, pll8, 4, 0, 0, LOW),
2318 F_IJPEG(109710000, pll8, 1, 2, 7, LOW),
2319 F_IJPEG(128000000, pll8, 3, 0, 0, NOMINAL),
2320 F_IJPEG(153600000, pll8, 1, 2, 5, NOMINAL),
2321 F_IJPEG(200000000, pll2, 4, 0, 0, NOMINAL),
2322 F_IJPEG(228571000, pll2, 1, 2, 7, NOMINAL),
2323 F_END
2324};
2325
2326static struct rcg_clk ijpeg_clk = {
2327 .b = {
2328 .ctl_reg = IJPEG_CC_REG,
2329 .en_mask = BIT(0),
2330 .reset_reg = SW_RESET_CORE_REG,
2331 .reset_mask = BIT(9),
2332 .halt_reg = DBG_BUS_VEC_A_REG,
2333 .halt_bit = 24,
2334 },
2335 .ns_reg = IJPEG_NS_REG,
2336 .md_reg = IJPEG_MD_REG,
2337 .root_en_mask = BIT(2),
2338 .ns_mask = (BM(23, 16) | BM(15, 12) | BM(2, 0)),
2339 .ctl_mask = BM(7, 6),
2340 .set_rate = set_rate_mnd,
2341 .freq_tbl = clk_tbl_ijpeg,
2342 .depends = &ijpeg_axi_clk.c,
2343 .current_freq = &local_dummy_freq,
2344 .c = {
2345 .dbg_name = "ijpeg_clk",
2346 .ops = &soc_clk_ops_8x60,
2347 CLK_INIT(ijpeg_clk.c),
2348 },
2349};
2350
2351#define F_JPEGD(f, s, d, v) \
2352 { \
2353 .freq_hz = f, \
2354 .src_clk = &s##_clk.c, \
2355 .ns_val = NS_DIVSRC(15, 12, d, 2, 0, s##_to_mm_mux), \
2356 .sys_vdd = v, \
2357 }
2358static struct clk_freq_tbl clk_tbl_jpegd[] = {
2359 F_JPEGD( 0, gnd, 1, NONE),
2360 F_JPEGD( 64000000, pll8, 6, LOW),
2361 F_JPEGD( 76800000, pll8, 5, LOW),
2362 F_JPEGD( 96000000, pll8, 4, LOW),
2363 F_JPEGD(160000000, pll2, 5, NOMINAL),
2364 F_JPEGD(200000000, pll2, 4, NOMINAL),
2365 F_END
2366};
2367
2368static struct rcg_clk jpegd_clk = {
2369 .b = {
2370 .ctl_reg = JPEGD_CC_REG,
2371 .en_mask = BIT(0),
2372 .reset_reg = SW_RESET_CORE_REG,
2373 .reset_mask = BIT(19),
2374 .halt_reg = DBG_BUS_VEC_A_REG,
2375 .halt_bit = 19,
2376 },
2377 .ns_reg = JPEGD_NS_REG,
2378 .root_en_mask = BIT(2),
2379 .ns_mask = (BM(15, 12) | BM(2, 0)),
2380 .set_rate = set_rate_nop,
2381 .freq_tbl = clk_tbl_jpegd,
2382 .depends = &jpegd_axi_clk.c,
2383 .current_freq = &local_dummy_freq,
2384 .c = {
2385 .dbg_name = "jpegd_clk",
2386 .ops = &soc_clk_ops_8x60,
2387 CLK_INIT(jpegd_clk.c),
2388 },
2389};
2390
2391#define F_MDP(f, s, m, n, v) \
2392 { \
2393 .freq_hz = f, \
2394 .src_clk = &s##_clk.c, \
2395 .md_val = MD8(8, m, 0, n), \
2396 .ns_val = NS_MND_BANKED8(22, 14, n, m, 3, 0, s##_to_mm_mux), \
2397 .ctl_val = CC_BANKED(9, 6, n), \
2398 .mnd_en_mask = (BIT(8) | BIT(5)) * !!(n), \
2399 .sys_vdd = v, \
2400 }
2401static struct clk_freq_tbl clk_tbl_mdp[] = {
2402 F_MDP( 0, gnd, 0, 0, NONE),
2403 F_MDP( 9600000, pll8, 1, 40, LOW),
2404 F_MDP( 13710000, pll8, 1, 28, LOW),
2405 F_MDP( 27000000, pxo, 0, 0, LOW),
2406 F_MDP( 29540000, pll8, 1, 13, LOW),
2407 F_MDP( 34910000, pll8, 1, 11, LOW),
2408 F_MDP( 38400000, pll8, 1, 10, LOW),
2409 F_MDP( 59080000, pll8, 2, 13, LOW),
2410 F_MDP( 76800000, pll8, 1, 5, LOW),
2411 F_MDP( 85330000, pll8, 2, 9, LOW),
2412 F_MDP( 96000000, pll8, 1, 4, NOMINAL),
2413 F_MDP(128000000, pll8, 1, 3, NOMINAL),
2414 F_MDP(160000000, pll2, 1, 5, NOMINAL),
2415 F_MDP(177780000, pll2, 2, 9, NOMINAL),
2416 F_MDP(200000000, pll2, 1, 4, NOMINAL),
2417 F_END
2418};
2419
2420static struct bank_masks bmnd_info_mdp = {
2421 .bank_sel_mask = BIT(11),
2422 .bank0_mask = {
2423 .md_reg = MDP_MD0_REG,
2424 .ns_mask = BM(29, 22) | BM(5, 3),
2425 .rst_mask = BIT(31),
2426 .mnd_en_mask = BIT(8),
2427 .mode_mask = BM(10, 9),
2428 },
2429 .bank1_mask = {
2430 .md_reg = MDP_MD1_REG,
2431 .ns_mask = BM(21, 14) | BM(2, 0),
2432 .rst_mask = BIT(30),
2433 .mnd_en_mask = BIT(5),
2434 .mode_mask = BM(7, 6),
2435 },
2436};
2437
2438static struct rcg_clk mdp_clk = {
2439 .b = {
2440 .ctl_reg = MDP_CC_REG,
2441 .en_mask = BIT(0),
2442 .reset_reg = SW_RESET_CORE_REG,
2443 .reset_mask = BIT(21),
2444 .halt_reg = DBG_BUS_VEC_C_REG,
2445 .halt_bit = 10,
2446 },
2447 .ns_reg = MDP_NS_REG,
2448 .root_en_mask = BIT(2),
2449 .set_rate = set_rate_mnd_banked,
2450 .freq_tbl = clk_tbl_mdp,
2451 .bank_masks = &bmnd_info_mdp,
2452 .depends = &mdp_axi_clk.c,
2453 .current_freq = &local_dummy_freq,
2454 .c = {
2455 .dbg_name = "mdp_clk",
2456 .ops = &soc_clk_ops_8x60,
2457 CLK_INIT(mdp_clk.c),
2458 },
2459};
2460
2461#define F_MDP_VSYNC(f, s, v) \
2462 { \
2463 .freq_hz = f, \
2464 .src_clk = &s##_clk.c, \
2465 .ns_val = NS_SRC_SEL(13, 13, s##_to_bb_mux), \
2466 .sys_vdd = v, \
2467 }
2468static struct clk_freq_tbl clk_tbl_mdp_vsync[] = {
2469 F_MDP_VSYNC(27000000, pxo, LOW),
2470 F_END
2471};
2472
2473static struct rcg_clk mdp_vsync_clk = {
2474 .b = {
2475 .ctl_reg = MISC_CC_REG,
2476 .en_mask = BIT(6),
2477 .reset_reg = SW_RESET_CORE_REG,
2478 .reset_mask = BIT(3),
2479 .halt_reg = DBG_BUS_VEC_B_REG,
2480 .halt_bit = 22,
2481 },
2482 .ns_reg = MISC_CC2_REG,
2483 .ns_mask = BIT(13),
2484 .set_rate = set_rate_nop,
2485 .freq_tbl = clk_tbl_mdp_vsync,
2486 .current_freq = &local_dummy_freq,
2487 .c = {
2488 .dbg_name = "mdp_vsync_clk",
2489 .ops = &soc_clk_ops_8x60,
2490 CLK_INIT(mdp_vsync_clk.c),
2491 },
2492};
2493
2494#define F_PIXEL_MDP(f, s, d, m, n, v) \
2495 { \
2496 .freq_hz = f, \
2497 .src_clk = &s##_clk.c, \
2498 .md_val = MD16(m, n), \
2499 .ns_val = NS_MM(31, 16, n, m, 15, 14, d, 2, 0, s##_to_mm_mux), \
2500 .ctl_val = CC(6, n), \
2501 .mnd_en_mask = BIT(5) * !!(n), \
2502 .sys_vdd = v, \
2503 }
2504static struct clk_freq_tbl clk_tbl_pixel_mdp[] = {
2505 F_PIXEL_MDP( 0, gnd, 1, 0, 0, NONE),
2506 F_PIXEL_MDP( 25600000, pll8, 3, 1, 5, LOW),
2507 F_PIXEL_MDP( 42667000, pll8, 1, 1, 9, LOW),
2508 F_PIXEL_MDP( 43192000, pll8, 1, 64, 569, LOW),
2509 F_PIXEL_MDP( 48000000, pll8, 4, 1, 2, LOW),
2510 F_PIXEL_MDP( 53990000, pll8, 2, 169, 601, LOW),
2511 F_PIXEL_MDP( 64000000, pll8, 2, 1, 3, LOW),
2512 F_PIXEL_MDP( 69300000, pll8, 1, 231, 1280, LOW),
2513 F_PIXEL_MDP( 76800000, pll8, 1, 1, 5, LOW),
2514 F_PIXEL_MDP( 85333000, pll8, 1, 2, 9, LOW),
2515 F_PIXEL_MDP(106500000, pll8, 1, 71, 256, NOMINAL),
2516 F_PIXEL_MDP(109714000, pll8, 1, 2, 7, NOMINAL),
2517 F_END
2518};
2519
2520static struct rcg_clk pixel_mdp_clk = {
2521 .ns_reg = PIXEL_NS_REG,
2522 .md_reg = PIXEL_MD_REG,
2523 .b = {
2524 .ctl_reg = PIXEL_CC_REG,
2525 .en_mask = BIT(0),
2526 .reset_reg = SW_RESET_CORE_REG,
2527 .reset_mask = BIT(5),
2528 .halt_reg = DBG_BUS_VEC_C_REG,
2529 .halt_bit = 23,
2530 },
2531 .root_en_mask = BIT(2),
2532 .ns_mask = (BM(31, 16) | BM(15, 14) | BM(2, 0)),
2533 .ctl_mask = BM(7, 6),
2534 .set_rate = set_rate_mnd,
2535 .freq_tbl = clk_tbl_pixel_mdp,
2536 .current_freq = &local_dummy_freq,
2537 .c = {
2538 .dbg_name = "pixel_mdp_clk",
2539 .ops = &soc_clk_ops_8x60,
2540 CLK_INIT(pixel_mdp_clk.c),
2541 },
2542};
2543
2544static struct branch_clk pixel_lcdc_clk = {
2545 .b = {
2546 .ctl_reg = PIXEL_CC_REG,
2547 .en_mask = BIT(8),
2548 .halt_reg = DBG_BUS_VEC_C_REG,
2549 .halt_bit = 21,
2550 },
2551 .parent = &pixel_mdp_clk.c,
2552 .c = {
2553 .dbg_name = "pixel_lcdc_clk",
2554 .ops = &clk_ops_branch,
2555 CLK_INIT(pixel_lcdc_clk.c),
2556 },
2557};
2558
2559#define F_ROT(f, s, d, v) \
2560 { \
2561 .freq_hz = f, \
2562 .src_clk = &s##_clk.c, \
2563 .ns_val = NS_DIVSRC_BANKED(29, 26, 25, 22, d, \
2564 21, 19, 18, 16, s##_to_mm_mux), \
2565 .sys_vdd = v, \
2566 }
2567static struct clk_freq_tbl clk_tbl_rot[] = {
2568 F_ROT( 0, gnd, 1, NONE),
2569 F_ROT( 27000000, pxo, 1, LOW),
2570 F_ROT( 29540000, pll8, 13, LOW),
2571 F_ROT( 32000000, pll8, 12, LOW),
2572 F_ROT( 38400000, pll8, 10, LOW),
2573 F_ROT( 48000000, pll8, 8, LOW),
2574 F_ROT( 54860000, pll8, 7, LOW),
2575 F_ROT( 64000000, pll8, 6, LOW),
2576 F_ROT( 76800000, pll8, 5, LOW),
2577 F_ROT( 96000000, pll8, 4, NOMINAL),
2578 F_ROT(100000000, pll2, 8, NOMINAL),
2579 F_ROT(114290000, pll2, 7, NOMINAL),
2580 F_ROT(133330000, pll2, 6, NOMINAL),
2581 F_ROT(160000000, pll2, 5, NOMINAL),
2582 F_END
2583};
2584
2585static struct bank_masks bdiv_info_rot = {
2586 .bank_sel_mask = BIT(30),
2587 .bank0_mask = {
2588 .ns_mask = BM(25, 22) | BM(18, 16),
2589 },
2590 .bank1_mask = {
2591 .ns_mask = BM(29, 26) | BM(21, 19),
2592 },
2593};
2594
2595static struct rcg_clk rot_clk = {
2596 .b = {
2597 .ctl_reg = ROT_CC_REG,
2598 .en_mask = BIT(0),
2599 .reset_reg = SW_RESET_CORE_REG,
2600 .reset_mask = BIT(2),
2601 .halt_reg = DBG_BUS_VEC_C_REG,
2602 .halt_bit = 15,
2603 },
2604 .ns_reg = ROT_NS_REG,
2605 .root_en_mask = BIT(2),
2606 .set_rate = set_rate_div_banked,
2607 .freq_tbl = clk_tbl_rot,
2608 .bank_masks = &bdiv_info_rot,
2609 .current_freq = &local_dummy_freq,
2610 .c = {
2611 .dbg_name = "rot_clk",
2612 .ops = &soc_clk_ops_8x60,
2613 CLK_INIT(rot_clk.c),
2614 },
2615};
2616
2617#define F_TV(f, s, p_r, d, m, n, v) \
2618 { \
2619 .freq_hz = f, \
2620 .src_clk = &s##_clk.c, \
2621 .md_val = MD8(8, m, 0, n), \
2622 .ns_val = NS_MM(23, 16, n, m, 15, 14, d, 2, 0, s##_to_mm_mux), \
2623 .ctl_val = CC(6, n), \
2624 .mnd_en_mask = BIT(5) * !!(n), \
2625 .sys_vdd = v, \
2626 .extra_freq_data = p_r, \
2627 }
2628/* Switching TV freqs requires PLL reconfiguration. */
2629static struct pll_rate mm_pll2_rate[] = {
2630 [0] = PLL_RATE( 7, 6301, 13500, 0, 4, 0x4248B), /* 50400500 Hz */
2631 [1] = PLL_RATE( 8, 0, 0, 0, 4, 0x4248B), /* 54000000 Hz */
2632 [2] = PLL_RATE(16, 2, 125, 0, 4, 0x5248F), /* 108108000 Hz */
2633 [3] = PLL_RATE(22, 0, 0, 2, 4, 0x6248B), /* 148500000 Hz */
2634 [4] = PLL_RATE(44, 0, 0, 2, 4, 0x6248F), /* 297000000 Hz */
2635};
2636static struct clk_freq_tbl clk_tbl_tv[] = {
2637 F_TV( 0, gnd, &mm_pll2_rate[0], 1, 0, 0, NONE),
2638 F_TV( 25200000, pll3, &mm_pll2_rate[0], 2, 0, 0, LOW),
2639 F_TV( 27000000, pll3, &mm_pll2_rate[1], 2, 0, 0, LOW),
2640 F_TV( 27030000, pll3, &mm_pll2_rate[2], 4, 0, 0, LOW),
2641 F_TV( 74250000, pll3, &mm_pll2_rate[3], 2, 0, 0, NOMINAL),
2642 F_TV(148500000, pll3, &mm_pll2_rate[4], 2, 0, 0, NOMINAL),
2643 F_END
2644};
2645
2646static struct rcg_clk tv_src_clk = {
2647 .ns_reg = TV_NS_REG,
2648 .b = {
2649 .ctl_reg = TV_CC_REG,
2650 .halt_check = NOCHECK,
2651 },
2652 .md_reg = TV_MD_REG,
2653 .root_en_mask = BIT(2),
2654 .ns_mask = (BM(23, 16) | BM(15, 14) | BM(2, 0)),
2655 .ctl_mask = BM(7, 6),
2656 .set_rate = set_rate_tv,
2657 .freq_tbl = clk_tbl_tv,
2658 .current_freq = &local_dummy_freq,
2659 .c = {
2660 .dbg_name = "tv_src_clk",
2661 .ops = &soc_clk_ops_8x60,
2662 CLK_INIT(tv_src_clk.c),
2663 },
2664};
2665
2666static struct branch_clk tv_enc_clk = {
2667 .b = {
2668 .ctl_reg = TV_CC_REG,
2669 .en_mask = BIT(8),
2670 .reset_reg = SW_RESET_CORE_REG,
2671 .reset_mask = BIT(0),
2672 .halt_reg = DBG_BUS_VEC_D_REG,
2673 .halt_bit = 8,
2674 },
2675 .parent = &tv_src_clk.c,
2676 .c = {
2677 .dbg_name = "tv_enc_clk",
2678 .ops = &clk_ops_branch,
2679 CLK_INIT(tv_enc_clk.c),
2680 },
2681};
2682
2683static struct branch_clk tv_dac_clk = {
2684 .b = {
2685 .ctl_reg = TV_CC_REG,
2686 .en_mask = BIT(10),
2687 .halt_reg = DBG_BUS_VEC_D_REG,
2688 .halt_bit = 9,
2689 },
2690 .parent = &tv_src_clk.c,
2691 .c = {
2692 .dbg_name = "tv_dac_clk",
2693 .ops = &clk_ops_branch,
2694 CLK_INIT(tv_dac_clk.c),
2695 },
2696};
2697
2698static struct branch_clk mdp_tv_clk = {
2699 .b = {
2700 .ctl_reg = TV_CC_REG,
2701 .en_mask = BIT(0),
2702 .reset_reg = SW_RESET_CORE_REG,
2703 .reset_mask = BIT(4),
2704 .halt_reg = DBG_BUS_VEC_D_REG,
2705 .halt_bit = 11,
2706 },
2707 .parent = &tv_src_clk.c,
2708 .c = {
2709 .dbg_name = "mdp_tv_clk",
2710 .ops = &clk_ops_branch,
2711 CLK_INIT(mdp_tv_clk.c),
2712 },
2713};
2714
2715static struct branch_clk hdmi_tv_clk = {
2716 .b = {
2717 .ctl_reg = TV_CC_REG,
2718 .en_mask = BIT(12),
2719 .reset_reg = SW_RESET_CORE_REG,
2720 .reset_mask = BIT(1),
2721 .halt_reg = DBG_BUS_VEC_D_REG,
2722 .halt_bit = 10,
2723 },
2724 .parent = &tv_src_clk.c,
2725 .c = {
2726 .dbg_name = "hdmi_tv_clk",
2727 .ops = &clk_ops_branch,
2728 CLK_INIT(hdmi_tv_clk.c),
2729 },
2730};
2731
2732static struct branch_clk hdmi_app_clk = {
2733 .b = {
2734 .ctl_reg = MISC_CC2_REG,
2735 .en_mask = BIT(11),
2736 .reset_reg = SW_RESET_CORE_REG,
2737 .reset_mask = BIT(11),
2738 .halt_reg = DBG_BUS_VEC_B_REG,
2739 .halt_bit = 25,
2740 },
2741 .c = {
2742 .dbg_name = "hdmi_app_clk",
2743 .ops = &clk_ops_branch,
2744 CLK_INIT(hdmi_app_clk.c),
2745 },
2746};
2747
2748#define F_VCODEC(f, s, m, n, v) \
2749 { \
2750 .freq_hz = f, \
2751 .src_clk = &s##_clk.c, \
2752 .md_val = MD8(8, m, 0, n), \
2753 .ns_val = NS_MM(18, 11, n, m, 0, 0, 1, 2, 0, s##_to_mm_mux), \
2754 .ctl_val = CC(6, n), \
2755 .mnd_en_mask = BIT(5) * !!(n), \
2756 .sys_vdd = v, \
2757 }
2758static struct clk_freq_tbl clk_tbl_vcodec[] = {
2759 F_VCODEC( 0, gnd, 0, 0, NONE),
2760 F_VCODEC( 27000000, pxo, 0, 0, LOW),
2761 F_VCODEC( 32000000, pll8, 1, 12, LOW),
2762 F_VCODEC( 48000000, pll8, 1, 8, LOW),
2763 F_VCODEC( 54860000, pll8, 1, 7, LOW),
2764 F_VCODEC( 96000000, pll8, 1, 4, LOW),
2765 F_VCODEC(133330000, pll2, 1, 6, NOMINAL),
2766 F_VCODEC(200000000, pll2, 1, 4, NOMINAL),
2767 F_VCODEC(228570000, pll2, 2, 7, HIGH),
2768 F_END
2769};
2770
2771static struct rcg_clk vcodec_clk = {
2772 .b = {
2773 .ctl_reg = VCODEC_CC_REG,
2774 .en_mask = BIT(0),
2775 .reset_reg = SW_RESET_CORE_REG,
2776 .reset_mask = BIT(6),
2777 .halt_reg = DBG_BUS_VEC_C_REG,
2778 .halt_bit = 29,
2779 },
2780 .ns_reg = VCODEC_NS_REG,
2781 .md_reg = VCODEC_MD0_REG,
2782 .root_en_mask = BIT(2),
2783 .ns_mask = (BM(18, 11) | BM(2, 0)),
2784 .ctl_mask = BM(7, 6),
2785 .set_rate = set_rate_mnd,
2786 .freq_tbl = clk_tbl_vcodec,
2787 .depends = &vcodec_axi_clk.c,
2788 .current_freq = &local_dummy_freq,
2789 .c = {
2790 .dbg_name = "vcodec_clk",
2791 .ops = &soc_clk_ops_8x60,
2792 CLK_INIT(vcodec_clk.c),
2793 },
2794};
2795
2796#define F_VPE(f, s, d, v) \
2797 { \
2798 .freq_hz = f, \
2799 .src_clk = &s##_clk.c, \
2800 .ns_val = NS_DIVSRC(15, 12, d, 2, 0, s##_to_mm_mux), \
2801 .sys_vdd = v, \
2802 }
2803static struct clk_freq_tbl clk_tbl_vpe[] = {
2804 F_VPE( 0, gnd, 1, NONE),
2805 F_VPE( 27000000, pxo, 1, LOW),
2806 F_VPE( 34909000, pll8, 11, LOW),
2807 F_VPE( 38400000, pll8, 10, LOW),
2808 F_VPE( 64000000, pll8, 6, LOW),
2809 F_VPE( 76800000, pll8, 5, LOW),
2810 F_VPE( 96000000, pll8, 4, NOMINAL),
2811 F_VPE(100000000, pll2, 8, NOMINAL),
2812 F_VPE(160000000, pll2, 5, NOMINAL),
2813 F_VPE(200000000, pll2, 4, HIGH),
2814 F_END
2815};
2816
2817static struct rcg_clk vpe_clk = {
2818 .b = {
2819 .ctl_reg = VPE_CC_REG,
2820 .en_mask = BIT(0),
2821 .reset_reg = SW_RESET_CORE_REG,
2822 .reset_mask = BIT(17),
2823 .halt_reg = DBG_BUS_VEC_A_REG,
2824 .halt_bit = 28,
2825 },
2826 .ns_reg = VPE_NS_REG,
2827 .root_en_mask = BIT(2),
2828 .ns_mask = (BM(15, 12) | BM(2, 0)),
2829 .set_rate = set_rate_nop,
2830 .freq_tbl = clk_tbl_vpe,
2831 .current_freq = &local_dummy_freq,
2832 .c = {
2833 .dbg_name = "vpe_clk",
2834 .ops = &soc_clk_ops_8x60,
2835 CLK_INIT(vpe_clk.c),
2836 },
2837};
2838
2839#define F_VFE(f, s, d, m, n, v) \
2840 { \
2841 .freq_hz = f, \
2842 .src_clk = &s##_clk.c, \
2843 .md_val = MD8(8, m, 0, n), \
2844 .ns_val = NS_MM(23, 16, n, m, 11, 10, d, 2, 0, s##_to_mm_mux), \
2845 .ctl_val = CC(6, n), \
2846 .mnd_en_mask = BIT(5) * !!(n), \
2847 .sys_vdd = v, \
2848 }
2849static struct clk_freq_tbl clk_tbl_vfe[] = {
2850 F_VFE( 0, gnd, 1, 0, 0, NONE),
2851 F_VFE( 13960000, pll8, 1, 2, 55, LOW),
2852 F_VFE( 27000000, pxo, 1, 0, 0, LOW),
2853 F_VFE( 36570000, pll8, 1, 2, 21, LOW),
2854 F_VFE( 38400000, pll8, 2, 1, 5, LOW),
2855 F_VFE( 45180000, pll8, 1, 2, 17, LOW),
2856 F_VFE( 48000000, pll8, 2, 1, 4, LOW),
2857 F_VFE( 54860000, pll8, 1, 1, 7, LOW),
2858 F_VFE( 64000000, pll8, 2, 1, 3, LOW),
2859 F_VFE( 76800000, pll8, 1, 1, 5, LOW),
2860 F_VFE( 96000000, pll8, 2, 1, 2, LOW),
2861 F_VFE(109710000, pll8, 1, 2, 7, LOW),
2862 F_VFE(128000000, pll8, 1, 1, 3, NOMINAL),
2863 F_VFE(153600000, pll8, 1, 2, 5, NOMINAL),
2864 F_VFE(200000000, pll2, 2, 1, 2, NOMINAL),
2865 F_VFE(228570000, pll2, 1, 2, 7, NOMINAL),
2866 F_VFE(266667000, pll2, 1, 1, 3, HIGH),
2867 F_END
2868};
2869
2870static struct rcg_clk vfe_clk = {
2871 .b = {
2872 .ctl_reg = VFE_CC_REG,
2873 .reset_reg = SW_RESET_CORE_REG,
2874 .reset_mask = BIT(15),
2875 .halt_reg = DBG_BUS_VEC_B_REG,
2876 .halt_bit = 6,
2877 .en_mask = BIT(0),
2878 },
2879 .ns_reg = VFE_NS_REG,
2880 .md_reg = VFE_MD_REG,
2881 .root_en_mask = BIT(2),
2882 .ns_mask = (BM(23, 16) | BM(11, 10) | BM(2, 0)),
2883 .ctl_mask = BM(7, 6),
2884 .set_rate = set_rate_mnd,
2885 .freq_tbl = clk_tbl_vfe,
2886 .depends = &vfe_axi_clk.c,
2887 .current_freq = &local_dummy_freq,
2888 .c = {
2889 .dbg_name = "vfe_clk",
2890 .ops = &soc_clk_ops_8x60,
2891 CLK_INIT(vfe_clk.c),
2892 },
2893};
2894
2895static struct branch_clk csi0_vfe_clk = {
2896 .b = {
2897 .ctl_reg = VFE_CC_REG,
2898 .en_mask = BIT(12),
2899 .reset_reg = SW_RESET_CORE_REG,
2900 .reset_mask = BIT(24),
2901 .halt_reg = DBG_BUS_VEC_B_REG,
2902 .halt_bit = 7,
2903 },
2904 .parent = &vfe_clk.c,
2905 .c = {
2906 .dbg_name = "csi0_vfe_clk",
2907 .ops = &clk_ops_branch,
2908 CLK_INIT(csi0_vfe_clk.c),
2909 },
2910};
2911
2912static struct branch_clk csi1_vfe_clk = {
2913 .b = {
2914 .ctl_reg = VFE_CC_REG,
2915 .en_mask = BIT(10),
2916 .reset_reg = SW_RESET_CORE_REG,
2917 .reset_mask = BIT(23),
2918 .halt_reg = DBG_BUS_VEC_B_REG,
2919 .halt_bit = 8,
2920 },
2921 .parent = &vfe_clk.c,
2922 .c = {
2923 .dbg_name = "csi1_vfe_clk",
2924 .ops = &clk_ops_branch,
2925 CLK_INIT(csi1_vfe_clk.c),
2926 },
2927};
2928
2929/*
2930 * Low Power Audio Clocks
2931 */
2932#define F_AIF_OSR(f, s, d, m, n, v) \
2933 { \
2934 .freq_hz = f, \
2935 .src_clk = &s##_clk.c, \
2936 .md_val = MD8(8, m, 0, n), \
2937 .ns_val = NS(31, 24, n, m, 5, 4, 3, d, 2, 0, s##_to_lpa_mux), \
2938 .mnd_en_mask = BIT(8) * !!(n), \
2939 .sys_vdd = v, \
2940 }
2941static struct clk_freq_tbl clk_tbl_aif_osr[] = {
2942 F_AIF_OSR( 0, gnd, 1, 0, 0, NONE),
2943 F_AIF_OSR( 768000, pll4, 4, 1, 176, LOW),
2944 F_AIF_OSR( 1024000, pll4, 4, 1, 132, LOW),
2945 F_AIF_OSR( 1536000, pll4, 4, 1, 88, LOW),
2946 F_AIF_OSR( 2048000, pll4, 4, 1, 66, LOW),
2947 F_AIF_OSR( 3072000, pll4, 4, 1, 44, LOW),
2948 F_AIF_OSR( 4096000, pll4, 4, 1, 33, LOW),
2949 F_AIF_OSR( 6144000, pll4, 4, 1, 22, LOW),
2950 F_AIF_OSR( 8192000, pll4, 2, 1, 33, LOW),
2951 F_AIF_OSR(12288000, pll4, 4, 1, 11, LOW),
2952 F_AIF_OSR(24576000, pll4, 2, 1, 11, LOW),
2953 F_END
2954};
2955
2956#define CLK_AIF_OSR(i, ns, md, h_r) \
2957 struct rcg_clk i##_clk = { \
2958 .b = { \
2959 .ctl_reg = ns, \
2960 .en_mask = BIT(17), \
2961 .reset_reg = ns, \
2962 .reset_mask = BIT(19), \
2963 .halt_reg = h_r, \
2964 .halt_check = ENABLE, \
2965 .halt_bit = 1, \
2966 }, \
2967 .ns_reg = ns, \
2968 .md_reg = md, \
2969 .root_en_mask = BIT(9), \
2970 .ns_mask = (BM(31, 24) | BM(6, 0)), \
2971 .set_rate = set_rate_mnd, \
2972 .freq_tbl = clk_tbl_aif_osr, \
2973 .current_freq = &local_dummy_freq, \
2974 .c = { \
2975 .dbg_name = #i "_clk", \
2976 .ops = &soc_clk_ops_8x60, \
2977 CLK_INIT(i##_clk.c), \
2978 }, \
2979 }
2980
2981#define F_AIF_BIT(d, s) \
2982 { \
2983 .freq_hz = d, \
2984 .ns_val = (BVAL(14, 14, s) | BVAL(13, 10, (d-1))) \
2985 }
2986static struct clk_freq_tbl clk_tbl_aif_bit[] = {
2987 F_AIF_BIT(0, 1), /* Use external clock. */
2988 F_AIF_BIT(1, 0), F_AIF_BIT(2, 0), F_AIF_BIT(3, 0), F_AIF_BIT(4, 0),
2989 F_AIF_BIT(5, 0), F_AIF_BIT(6, 0), F_AIF_BIT(7, 0), F_AIF_BIT(8, 0),
2990 F_AIF_BIT(9, 0), F_AIF_BIT(10, 0), F_AIF_BIT(11, 0), F_AIF_BIT(12, 0),
2991 F_AIF_BIT(13, 0), F_AIF_BIT(14, 0), F_AIF_BIT(15, 0), F_AIF_BIT(16, 0),
2992 F_END
2993};
2994
2995#define CLK_AIF_BIT(i, ns, h_r) \
2996 struct rcg_clk i##_clk = { \
2997 .b = { \
2998 .ctl_reg = ns, \
2999 .en_mask = BIT(15), \
3000 .halt_reg = h_r, \
3001 .halt_check = DELAY, \
3002 }, \
3003 .ns_reg = ns, \
3004 .ns_mask = BM(14, 10), \
3005 .set_rate = set_rate_nop, \
3006 .freq_tbl = clk_tbl_aif_bit, \
3007 .current_freq = &local_dummy_freq, \
3008 .c = { \
3009 .dbg_name = #i "_clk", \
3010 .ops = &soc_clk_ops_8x60, \
3011 CLK_INIT(i##_clk.c), \
3012 }, \
3013 }
3014
3015static CLK_AIF_OSR(mi2s_osr, LCC_MI2S_NS_REG, LCC_MI2S_MD_REG,
3016 LCC_MI2S_STATUS_REG);
3017static CLK_AIF_BIT(mi2s_bit, LCC_MI2S_NS_REG, LCC_MI2S_STATUS_REG);
3018
3019static CLK_AIF_OSR(codec_i2s_mic_osr, LCC_CODEC_I2S_MIC_NS_REG,
3020 LCC_CODEC_I2S_MIC_MD_REG, LCC_CODEC_I2S_MIC_STATUS_REG);
3021static CLK_AIF_BIT(codec_i2s_mic_bit, LCC_CODEC_I2S_MIC_NS_REG,
3022 LCC_CODEC_I2S_MIC_STATUS_REG);
3023
3024static CLK_AIF_OSR(spare_i2s_mic_osr, LCC_SPARE_I2S_MIC_NS_REG,
3025 LCC_SPARE_I2S_MIC_MD_REG, LCC_SPARE_I2S_MIC_STATUS_REG);
3026static CLK_AIF_BIT(spare_i2s_mic_bit, LCC_SPARE_I2S_MIC_NS_REG,
3027 LCC_SPARE_I2S_MIC_STATUS_REG);
3028
3029static CLK_AIF_OSR(codec_i2s_spkr_osr, LCC_CODEC_I2S_SPKR_NS_REG,
3030 LCC_CODEC_I2S_SPKR_MD_REG, LCC_CODEC_I2S_SPKR_STATUS_REG);
3031static CLK_AIF_BIT(codec_i2s_spkr_bit, LCC_CODEC_I2S_SPKR_NS_REG,
3032 LCC_CODEC_I2S_SPKR_STATUS_REG);
3033
3034static CLK_AIF_OSR(spare_i2s_spkr_osr, LCC_SPARE_I2S_SPKR_NS_REG,
3035 LCC_SPARE_I2S_SPKR_MD_REG, LCC_SPARE_I2S_SPKR_STATUS_REG);
3036static CLK_AIF_BIT(spare_i2s_spkr_bit, LCC_SPARE_I2S_SPKR_NS_REG,
3037 LCC_SPARE_I2S_SPKR_STATUS_REG);
3038
3039#define F_PCM(f, s, d, m, n, v) \
3040 { \
3041 .freq_hz = f, \
3042 .src_clk = &s##_clk.c, \
3043 .md_val = MD16(m, n), \
3044 .ns_val = NS(31, 16, n, m, 5, 4, 3, d, 2, 0, s##_to_lpa_mux), \
3045 .mnd_en_mask = BIT(8) * !!(n), \
3046 .sys_vdd = v, \
3047 }
3048static struct clk_freq_tbl clk_tbl_pcm[] = {
3049 F_PCM( 0, gnd, 1, 0, 0, NONE),
3050 F_PCM( 512000, pll4, 4, 1, 264, LOW),
3051 F_PCM( 768000, pll4, 4, 1, 176, LOW),
3052 F_PCM( 1024000, pll4, 4, 1, 132, LOW),
3053 F_PCM( 1536000, pll4, 4, 1, 88, LOW),
3054 F_PCM( 2048000, pll4, 4, 1, 66, LOW),
3055 F_PCM( 3072000, pll4, 4, 1, 44, LOW),
3056 F_PCM( 4096000, pll4, 4, 1, 33, LOW),
3057 F_PCM( 6144000, pll4, 4, 1, 22, LOW),
3058 F_PCM( 8192000, pll4, 2, 1, 33, LOW),
3059 F_PCM(12288000, pll4, 4, 1, 11, LOW),
3060 F_PCM(24580000, pll4, 2, 1, 11, LOW),
3061 F_END
3062};
3063
3064static struct rcg_clk pcm_clk = {
3065 .b = {
3066 .ctl_reg = LCC_PCM_NS_REG,
3067 .en_mask = BIT(11),
3068 .reset_reg = LCC_PCM_NS_REG,
3069 .reset_mask = BIT(13),
3070 .halt_reg = LCC_PCM_STATUS_REG,
3071 .halt_check = ENABLE,
3072 .halt_bit = 0,
3073 },
3074 .ns_reg = LCC_PCM_NS_REG,
3075 .md_reg = LCC_PCM_MD_REG,
3076 .root_en_mask = BIT(9),
3077 .ns_mask = (BM(31, 16) | BM(6, 0)),
3078 .set_rate = set_rate_mnd,
3079 .freq_tbl = clk_tbl_pcm,
3080 .current_freq = &local_dummy_freq,
3081 .c = {
3082 .dbg_name = "pcm_clk",
3083 .ops = &soc_clk_ops_8x60,
3084 CLK_INIT(pcm_clk.c),
3085 },
3086};
3087
3088DEFINE_CLK_RPM(afab_clk, afab_a_clk, APPS_FABRIC);
3089DEFINE_CLK_RPM(cfpb_clk, cfpb_a_clk, CFPB);
3090DEFINE_CLK_RPM(dfab_clk, dfab_a_clk, DAYTONA_FABRIC);
3091DEFINE_CLK_RPM(ebi1_clk, ebi1_a_clk, EBI1);
3092DEFINE_CLK_RPM(mmfab_clk, mmfab_a_clk, MM_FABRIC);
3093DEFINE_CLK_RPM(mmfpb_clk, mmfpb_a_clk, MMFPB);
3094DEFINE_CLK_RPM(sfab_clk, sfab_a_clk, SYSTEM_FABRIC);
3095DEFINE_CLK_RPM(sfpb_clk, sfpb_a_clk, SFPB);
3096DEFINE_CLK_RPM(smi_clk, smi_a_clk, SMI);
3097
3098static DEFINE_CLK_VOTER(dfab_dsps_clk, &dfab_clk.c);
3099static DEFINE_CLK_VOTER(dfab_usb_hs_clk, &dfab_clk.c);
3100static DEFINE_CLK_VOTER(dfab_sdc1_clk, &dfab_clk.c);
3101static DEFINE_CLK_VOTER(dfab_sdc2_clk, &dfab_clk.c);
3102static DEFINE_CLK_VOTER(dfab_sdc3_clk, &dfab_clk.c);
3103static DEFINE_CLK_VOTER(dfab_sdc4_clk, &dfab_clk.c);
3104static DEFINE_CLK_VOTER(dfab_sdc5_clk, &dfab_clk.c);
3105
3106static DEFINE_CLK_VOTER(ebi1_msmbus_clk, &ebi1_clk.c);
3107static DEFINE_CLK_VOTER(ebi1_adm0_clk, &ebi1_clk.c);
3108static DEFINE_CLK_VOTER(ebi1_adm1_clk, &ebi1_clk.c);
3109
3110static DEFINE_CLK_MEASURE(sc0_m_clk);
3111static DEFINE_CLK_MEASURE(sc1_m_clk);
3112static DEFINE_CLK_MEASURE(l2_m_clk);
3113
3114#ifdef CONFIG_DEBUG_FS
3115struct measure_sel {
3116 u32 test_vector;
3117 struct clk *clk;
3118};
3119
3120static struct measure_sel measure_mux[] = {
3121 { TEST_PER_LS(0x08), &modem_ahb1_p_clk.c },
3122 { TEST_PER_LS(0x09), &modem_ahb2_p_clk.c },
3123 { TEST_PER_LS(0x12), &sdc1_p_clk.c },
3124 { TEST_PER_LS(0x13), &sdc1_clk.c },
3125 { TEST_PER_LS(0x14), &sdc2_p_clk.c },
3126 { TEST_PER_LS(0x15), &sdc2_clk.c },
3127 { TEST_PER_LS(0x16), &sdc3_p_clk.c },
3128 { TEST_PER_LS(0x17), &sdc3_clk.c },
3129 { TEST_PER_LS(0x18), &sdc4_p_clk.c },
3130 { TEST_PER_LS(0x19), &sdc4_clk.c },
3131 { TEST_PER_LS(0x1A), &sdc5_p_clk.c },
3132 { TEST_PER_LS(0x1B), &sdc5_clk.c },
3133 { TEST_PER_LS(0x25), &dfab_clk.c },
3134 { TEST_PER_LS(0x25), &dfab_a_clk.c },
3135 { TEST_PER_LS(0x26), &pmem_clk.c },
3136 { TEST_PER_LS(0x2B), &ppss_p_clk.c },
3137 { TEST_PER_LS(0x33), &cfpb_clk.c },
3138 { TEST_PER_LS(0x33), &cfpb_a_clk.c },
3139 { TEST_PER_LS(0x3D), &gsbi1_p_clk.c },
3140 { TEST_PER_LS(0x3E), &gsbi1_uart_clk.c },
3141 { TEST_PER_LS(0x3F), &gsbi1_qup_clk.c },
3142 { TEST_PER_LS(0x41), &gsbi2_p_clk.c },
3143 { TEST_PER_LS(0x42), &gsbi2_uart_clk.c },
3144 { TEST_PER_LS(0x44), &gsbi2_qup_clk.c },
3145 { TEST_PER_LS(0x45), &gsbi3_p_clk.c },
3146 { TEST_PER_LS(0x46), &gsbi3_uart_clk.c },
3147 { TEST_PER_LS(0x48), &gsbi3_qup_clk.c },
3148 { TEST_PER_LS(0x49), &gsbi4_p_clk.c },
3149 { TEST_PER_LS(0x4A), &gsbi4_uart_clk.c },
3150 { TEST_PER_LS(0x4C), &gsbi4_qup_clk.c },
3151 { TEST_PER_LS(0x4D), &gsbi5_p_clk.c },
3152 { TEST_PER_LS(0x4E), &gsbi5_uart_clk.c },
3153 { TEST_PER_LS(0x50), &gsbi5_qup_clk.c },
3154 { TEST_PER_LS(0x51), &gsbi6_p_clk.c },
3155 { TEST_PER_LS(0x52), &gsbi6_uart_clk.c },
3156 { TEST_PER_LS(0x54), &gsbi6_qup_clk.c },
3157 { TEST_PER_LS(0x55), &gsbi7_p_clk.c },
3158 { TEST_PER_LS(0x56), &gsbi7_uart_clk.c },
3159 { TEST_PER_LS(0x58), &gsbi7_qup_clk.c },
3160 { TEST_PER_LS(0x59), &gsbi8_p_clk.c },
3161 { TEST_PER_LS(0x5A), &gsbi8_uart_clk.c },
3162 { TEST_PER_LS(0x5C), &gsbi8_qup_clk.c },
3163 { TEST_PER_LS(0x5D), &gsbi9_p_clk.c },
3164 { TEST_PER_LS(0x5E), &gsbi9_uart_clk.c },
3165 { TEST_PER_LS(0x60), &gsbi9_qup_clk.c },
3166 { TEST_PER_LS(0x61), &gsbi10_p_clk.c },
3167 { TEST_PER_LS(0x62), &gsbi10_uart_clk.c },
3168 { TEST_PER_LS(0x64), &gsbi10_qup_clk.c },
3169 { TEST_PER_LS(0x65), &gsbi11_p_clk.c },
3170 { TEST_PER_LS(0x66), &gsbi11_uart_clk.c },
3171 { TEST_PER_LS(0x68), &gsbi11_qup_clk.c },
3172 { TEST_PER_LS(0x69), &gsbi12_p_clk.c },
3173 { TEST_PER_LS(0x6A), &gsbi12_uart_clk.c },
3174 { TEST_PER_LS(0x6C), &gsbi12_qup_clk.c },
3175 { TEST_PER_LS(0x78), &sfpb_clk.c },
3176 { TEST_PER_LS(0x78), &sfpb_a_clk.c },
3177 { TEST_PER_LS(0x7A), &pmic_ssbi2_clk.c },
3178 { TEST_PER_LS(0x7B), &pmic_arb0_p_clk.c },
3179 { TEST_PER_LS(0x7C), &pmic_arb1_p_clk.c },
3180 { TEST_PER_LS(0x7D), &prng_clk.c },
3181 { TEST_PER_LS(0x7F), &rpm_msg_ram_p_clk.c },
3182 { TEST_PER_LS(0x80), &adm0_p_clk.c },
3183 { TEST_PER_LS(0x81), &adm1_p_clk.c },
3184 { TEST_PER_LS(0x84), &usb_hs1_p_clk.c },
3185 { TEST_PER_LS(0x85), &usb_hs1_xcvr_clk.c },
3186 { TEST_PER_LS(0x89), &usb_fs1_p_clk.c },
3187 { TEST_PER_LS(0x8A), &usb_fs1_sys_clk.c },
3188 { TEST_PER_LS(0x8B), &usb_fs1_xcvr_clk.c },
3189 { TEST_PER_LS(0x8C), &usb_fs2_p_clk.c },
3190 { TEST_PER_LS(0x8D), &usb_fs2_sys_clk.c },
3191 { TEST_PER_LS(0x8E), &usb_fs2_xcvr_clk.c },
3192 { TEST_PER_LS(0x8F), &tsif_p_clk.c },
3193 { TEST_PER_LS(0x91), &tsif_ref_clk.c },
3194 { TEST_PER_LS(0x93), &ce2_p_clk.c },
3195 { TEST_PER_LS(0x94), &tssc_clk.c },
3196
3197 { TEST_PER_HS(0x07), &afab_clk.c },
3198 { TEST_PER_HS(0x07), &afab_a_clk.c },
3199 { TEST_PER_HS(0x18), &sfab_clk.c },
3200 { TEST_PER_HS(0x18), &sfab_a_clk.c },
3201 { TEST_PER_HS(0x2A), &adm0_clk.c },
3202 { TEST_PER_HS(0x2B), &adm1_clk.c },
3203 { TEST_PER_HS(0x34), &ebi1_clk.c },
3204 { TEST_PER_HS(0x34), &ebi1_a_clk.c },
3205
3206 { TEST_MM_LS(0x00), &dsi_byte_clk.c },
3207 { TEST_MM_LS(0x01), &pixel_lcdc_clk.c },
3208 { TEST_MM_LS(0x04), &pixel_mdp_clk.c },
3209 { TEST_MM_LS(0x06), &amp_p_clk.c },
3210 { TEST_MM_LS(0x07), &csi0_p_clk.c },
3211 { TEST_MM_LS(0x08), &csi1_p_clk.c },
3212 { TEST_MM_LS(0x09), &dsi_m_p_clk.c },
3213 { TEST_MM_LS(0x0A), &dsi_s_p_clk.c },
3214 { TEST_MM_LS(0x0C), &gfx2d0_p_clk.c },
3215 { TEST_MM_LS(0x0D), &gfx2d1_p_clk.c },
3216 { TEST_MM_LS(0x0E), &gfx3d_p_clk.c },
3217 { TEST_MM_LS(0x0F), &hdmi_m_p_clk.c },
3218 { TEST_MM_LS(0x10), &hdmi_s_p_clk.c },
3219 { TEST_MM_LS(0x11), &ijpeg_p_clk.c },
3220 { TEST_MM_LS(0x12), &imem_p_clk.c },
3221 { TEST_MM_LS(0x13), &jpegd_p_clk.c },
3222 { TEST_MM_LS(0x14), &mdp_p_clk.c },
3223 { TEST_MM_LS(0x16), &rot_p_clk.c },
3224 { TEST_MM_LS(0x18), &smmu_p_clk.c },
3225 { TEST_MM_LS(0x19), &tv_enc_p_clk.c },
3226 { TEST_MM_LS(0x1A), &vcodec_p_clk.c },
3227 { TEST_MM_LS(0x1B), &vfe_p_clk.c },
3228 { TEST_MM_LS(0x1C), &vpe_p_clk.c },
3229 { TEST_MM_LS(0x1D), &cam_clk.c },
3230 { TEST_MM_LS(0x1F), &hdmi_app_clk.c },
3231 { TEST_MM_LS(0x20), &mdp_vsync_clk.c },
3232 { TEST_MM_LS(0x21), &tv_dac_clk.c },
3233 { TEST_MM_LS(0x22), &tv_enc_clk.c },
3234 { TEST_MM_LS(0x23), &dsi_esc_clk.c },
3235 { TEST_MM_LS(0x25), &mmfpb_clk.c },
3236 { TEST_MM_LS(0x25), &mmfpb_a_clk.c },
3237
3238 { TEST_MM_HS(0x00), &csi0_clk.c },
3239 { TEST_MM_HS(0x01), &csi1_clk.c },
3240 { TEST_MM_HS(0x03), &csi0_vfe_clk.c },
3241 { TEST_MM_HS(0x04), &csi1_vfe_clk.c },
3242 { TEST_MM_HS(0x05), &ijpeg_clk.c },
3243 { TEST_MM_HS(0x06), &vfe_clk.c },
3244 { TEST_MM_HS(0x07), &gfx2d0_clk.c },
3245 { TEST_MM_HS(0x08), &gfx2d1_clk.c },
3246 { TEST_MM_HS(0x09), &gfx3d_clk.c },
3247 { TEST_MM_HS(0x0A), &jpegd_clk.c },
3248 { TEST_MM_HS(0x0B), &vcodec_clk.c },
3249 { TEST_MM_HS(0x0F), &mmfab_clk.c },
3250 { TEST_MM_HS(0x0F), &mmfab_a_clk.c },
3251 { TEST_MM_HS(0x11), &gmem_axi_clk.c },
3252 { TEST_MM_HS(0x12), &ijpeg_axi_clk.c },
3253 { TEST_MM_HS(0x13), &imem_axi_clk.c },
3254 { TEST_MM_HS(0x14), &jpegd_axi_clk.c },
3255 { TEST_MM_HS(0x15), &mdp_axi_clk.c },
3256 { TEST_MM_HS(0x17), &vcodec_axi_clk.c },
3257 { TEST_MM_HS(0x18), &vfe_axi_clk.c },
3258 { TEST_MM_HS(0x1A), &mdp_clk.c },
3259 { TEST_MM_HS(0x1B), &rot_clk.c },
3260 { TEST_MM_HS(0x1C), &vpe_clk.c },
3261 { TEST_MM_HS(0x1E), &hdmi_tv_clk.c },
3262 { TEST_MM_HS(0x1F), &mdp_tv_clk.c },
3263
3264 { TEST_MM_HS2X(0x24), &smi_clk.c },
3265 { TEST_MM_HS2X(0x24), &smi_a_clk.c },
3266
3267 { TEST_LPA(0x0A), &mi2s_osr_clk.c },
3268 { TEST_LPA(0x0B), &mi2s_bit_clk.c },
3269 { TEST_LPA(0x0C), &codec_i2s_mic_osr_clk.c },
3270 { TEST_LPA(0x0D), &codec_i2s_mic_bit_clk.c },
3271 { TEST_LPA(0x0E), &codec_i2s_spkr_osr_clk.c },
3272 { TEST_LPA(0x0F), &codec_i2s_spkr_bit_clk.c },
3273 { TEST_LPA(0x10), &spare_i2s_mic_osr_clk.c },
3274 { TEST_LPA(0x11), &spare_i2s_mic_bit_clk.c },
3275 { TEST_LPA(0x12), &spare_i2s_spkr_osr_clk.c },
3276 { TEST_LPA(0x13), &spare_i2s_spkr_bit_clk.c },
3277 { TEST_LPA(0x14), &pcm_clk.c },
3278
3279 { TEST_SC(0x40), &sc0_m_clk },
3280 { TEST_SC(0x41), &sc1_m_clk },
3281 { TEST_SC(0x42), &l2_m_clk },
3282};
3283
3284static struct measure_sel *find_measure_sel(struct clk *clk)
3285{
3286 int i;
3287
3288 for (i = 0; i < ARRAY_SIZE(measure_mux); i++)
3289 if (measure_mux[i].clk == clk)
3290 return &measure_mux[i];
3291 return NULL;
3292}
3293
3294static int measure_clk_set_parent(struct clk *c, struct clk *parent)
3295{
3296 int ret = 0;
3297 u32 clk_sel;
3298 struct measure_sel *p;
3299 struct measure_clk *clk = to_measure_clk(c);
3300 unsigned long flags;
3301
3302 if (!parent)
3303 return -EINVAL;
3304
3305 p = find_measure_sel(parent);
3306 if (!p)
3307 return -EINVAL;
3308
3309 spin_lock_irqsave(&local_clock_reg_lock, flags);
3310
3311 /*
3312 * Program the test vector, measurement period (sample_ticks)
3313 * and scaling factors (multiplier, divider).
3314 */
3315 clk_sel = p->test_vector & TEST_CLK_SEL_MASK;
3316 clk->sample_ticks = 0x10000;
3317 clk->multiplier = 1;
3318 clk->divider = 1;
3319 switch (p->test_vector >> TEST_TYPE_SHIFT) {
3320 case TEST_TYPE_PER_LS:
3321 writel_relaxed(0x4030D00|BVAL(7, 0, clk_sel), CLK_TEST_REG);
3322 break;
3323 case TEST_TYPE_PER_HS:
3324 writel_relaxed(0x4020000|BVAL(16, 10, clk_sel), CLK_TEST_REG);
3325 break;
3326 case TEST_TYPE_MM_LS:
3327 writel_relaxed(0x4030D97, CLK_TEST_REG);
3328 writel_relaxed(BVAL(6, 1, clk_sel)|BIT(0), DBG_CFG_REG_LS_REG);
3329 break;
3330 case TEST_TYPE_MM_HS2X:
3331 clk->divider = 2;
3332 case TEST_TYPE_MM_HS:
3333 writel_relaxed(0x402B800, CLK_TEST_REG);
3334 writel_relaxed(BVAL(6, 1, clk_sel)|BIT(0), DBG_CFG_REG_HS_REG);
3335 break;
3336 case TEST_TYPE_LPA:
3337 writel_relaxed(0x4030D98, CLK_TEST_REG);
3338 writel_relaxed(BVAL(6, 1, clk_sel)|BIT(0),
3339 LCC_CLK_LS_DEBUG_CFG_REG);
3340 break;
3341 case TEST_TYPE_SC:
3342 writel_relaxed(0x5020000|BVAL(16, 10, clk_sel), CLK_TEST_REG);
3343 clk->sample_ticks = 0x4000;
3344 clk->multiplier = 2;
3345 break;
3346 default:
3347 ret = -EPERM;
3348 }
3349 /* Make sure test vector is set before starting measurements. */
3350 mb();
3351
3352 spin_unlock_irqrestore(&local_clock_reg_lock, flags);
3353
3354 return ret;
3355}
3356
3357/* Sample clock for 'ticks' reference clock ticks. */
3358static u32 run_measurement(unsigned ticks)
3359{
3360 /* Stop counters and set the XO4 counter start value. */
3361 writel_relaxed(0x0, RINGOSC_TCXO_CTL_REG);
3362 writel_relaxed(ticks, RINGOSC_TCXO_CTL_REG);
3363
3364 /* Wait for timer to become ready. */
3365 while ((readl_relaxed(RINGOSC_STATUS_REG) & BIT(25)) != 0)
3366 cpu_relax();
3367
3368 /* Run measurement and wait for completion. */
3369 writel_relaxed(BIT(20)|ticks, RINGOSC_TCXO_CTL_REG);
3370 while ((readl_relaxed(RINGOSC_STATUS_REG) & BIT(25)) == 0)
3371 cpu_relax();
3372
3373 /* Stop counters. */
3374 writel_relaxed(0x0, RINGOSC_TCXO_CTL_REG);
3375
3376 /* Return measured ticks. */
3377 return readl_relaxed(RINGOSC_STATUS_REG) & BM(24, 0);
3378}
3379
3380/* Perform a hardware rate measurement for a given clock.
3381 FOR DEBUG USE ONLY: Measurements take ~15 ms! */
3382static unsigned measure_clk_get_rate(struct clk *c)
3383{
3384 unsigned long flags;
3385 u32 pdm_reg_backup, ringosc_reg_backup;
3386 u64 raw_count_short, raw_count_full;
3387 struct measure_clk *clk = to_measure_clk(c);
3388 unsigned ret;
3389
3390 spin_lock_irqsave(&local_clock_reg_lock, flags);
3391
3392 /* Enable CXO/4 and RINGOSC branch and root. */
3393 pdm_reg_backup = readl_relaxed(PDM_CLK_NS_REG);
3394 ringosc_reg_backup = readl_relaxed(RINGOSC_NS_REG);
3395 writel_relaxed(0x2898, PDM_CLK_NS_REG);
3396 writel_relaxed(0xA00, RINGOSC_NS_REG);
3397
3398 /*
3399 * The ring oscillator counter will not reset if the measured clock
3400 * is not running. To detect this, run a short measurement before
3401 * the full measurement. If the raw results of the two are the same
3402 * then the clock must be off.
3403 */
3404
3405 /* Run a short measurement. (~1 ms) */
3406 raw_count_short = run_measurement(0x1000);
3407 /* Run a full measurement. (~14 ms) */
3408 raw_count_full = run_measurement(clk->sample_ticks);
3409
3410 writel_relaxed(ringosc_reg_backup, RINGOSC_NS_REG);
3411 writel_relaxed(pdm_reg_backup, PDM_CLK_NS_REG);
3412
3413 /* Return 0 if the clock is off. */
3414 if (raw_count_full == raw_count_short)
3415 ret = 0;
3416 else {
3417 /* Compute rate in Hz. */
3418 raw_count_full = ((raw_count_full * 10) + 15) * 4800000;
3419 do_div(raw_count_full,
3420 (((clk->sample_ticks * 10) + 35) * clk->divider));
3421 ret = (raw_count_full * clk->multiplier);
3422 }
3423
3424 /* Route dbg_hs_clk to PLLTEST. 300mV single-ended amplitude. */
3425 writel_relaxed(0x3CF8, PLLTEST_PAD_CFG_REG);
3426 spin_unlock_irqrestore(&local_clock_reg_lock, flags);
3427
3428 return ret;
3429}
3430#else /* !CONFIG_DEBUG_FS */
3431static int measure_clk_set_parent(struct clk *clk, struct clk *parent)
3432{
3433 return -EINVAL;
3434}
3435
3436static unsigned measure_clk_get_rate(struct clk *clk)
3437{
3438 return 0;
3439}
3440#endif /* CONFIG_DEBUG_FS */
3441
3442static struct clk_ops measure_clk_ops = {
3443 .set_parent = measure_clk_set_parent,
3444 .get_rate = measure_clk_get_rate,
3445 .is_local = local_clk_is_local,
3446};
3447
3448static struct measure_clk measure_clk = {
3449 .c = {
3450 .dbg_name = "measure_clk",
3451 .ops = &measure_clk_ops,
3452 CLK_INIT(measure_clk.c),
3453 },
3454 .multiplier = 1,
3455 .divider = 1,
3456};
3457
3458static struct clk_lookup msm_clocks_8x60[] = {
3459 CLK_LOOKUP("cxo", cxo_clk.c, NULL),
3460 CLK_LOOKUP("pll4", pll4_clk.c, NULL),
3461 CLK_LOOKUP("pll4", pll4_clk.c, "peripheral-reset"),
3462 CLK_LOOKUP("measure", measure_clk.c, "debug"),
3463
3464 CLK_LOOKUP("afab_clk", afab_clk.c, NULL),
3465 CLK_LOOKUP("afab_a_clk", afab_a_clk.c, NULL),
3466 CLK_LOOKUP("cfpb_clk", cfpb_clk.c, NULL),
3467 CLK_LOOKUP("cfpb_a_clk", cfpb_a_clk.c, NULL),
3468 CLK_LOOKUP("dfab_clk", dfab_clk.c, NULL),
3469 CLK_LOOKUP("dfab_a_clk", dfab_a_clk.c, NULL),
3470 CLK_LOOKUP("ebi1_clk", ebi1_clk.c, NULL),
3471 CLK_LOOKUP("ebi1_a_clk", ebi1_a_clk.c, NULL),
3472 CLK_LOOKUP("mmfab_clk", mmfab_clk.c, NULL),
3473 CLK_LOOKUP("mmfab_a_clk", mmfab_a_clk.c, NULL),
3474 CLK_LOOKUP("mmfpb_clk", mmfpb_clk.c, NULL),
3475 CLK_LOOKUP("mmfpb_a_clk", mmfpb_a_clk.c, NULL),
3476 CLK_LOOKUP("sfab_clk", sfab_clk.c, NULL),
3477 CLK_LOOKUP("sfab_a_clk", sfab_a_clk.c, NULL),
3478 CLK_LOOKUP("sfpb_clk", sfpb_clk.c, NULL),
3479 CLK_LOOKUP("sfpb_a_clk", sfpb_a_clk.c, NULL),
3480 CLK_LOOKUP("smi_clk", smi_clk.c, NULL),
3481 CLK_LOOKUP("smi_a_clk", smi_a_clk.c, NULL),
3482
3483 CLK_LOOKUP("gsbi_uart_clk", gsbi1_uart_clk.c, NULL),
3484 CLK_LOOKUP("gsbi_uart_clk", gsbi2_uart_clk.c, NULL),
3485 CLK_LOOKUP("gsbi_uart_clk", gsbi3_uart_clk.c, "msm_serial_hsl.2"),
3486 CLK_LOOKUP("gsbi_uart_clk", gsbi4_uart_clk.c, NULL),
3487 CLK_LOOKUP("gsbi_uart_clk", gsbi5_uart_clk.c, NULL),
3488 CLK_LOOKUP("uartdm_clk", gsbi6_uart_clk.c, "msm_serial_hs.0"),
3489 CLK_LOOKUP("gsbi_uart_clk", gsbi7_uart_clk.c, NULL),
3490 CLK_LOOKUP("gsbi_uart_clk", gsbi8_uart_clk.c, NULL),
3491 CLK_LOOKUP("gsbi_uart_clk", gsbi9_uart_clk.c, "msm_serial_hsl.1"),
3492 CLK_LOOKUP("gsbi_uart_clk", gsbi10_uart_clk.c, NULL),
3493 CLK_LOOKUP("gsbi_uart_clk", gsbi11_uart_clk.c, NULL),
3494 CLK_LOOKUP("gsbi_uart_clk", gsbi12_uart_clk.c, "msm_serial_hsl.0"),
3495 CLK_LOOKUP("spi_clk", gsbi1_qup_clk.c, "spi_qsd.0"),
3496 CLK_LOOKUP("gsbi_qup_clk", gsbi2_qup_clk.c, NULL),
3497 CLK_LOOKUP("gsbi_qup_clk", gsbi3_qup_clk.c, "qup_i2c.0"),
3498 CLK_LOOKUP("gsbi_qup_clk", gsbi4_qup_clk.c, "qup_i2c.1"),
3499 CLK_LOOKUP("gsbi_qup_clk", gsbi5_qup_clk.c, NULL),
3500 CLK_LOOKUP("gsbi_qup_clk", gsbi6_qup_clk.c, NULL),
3501 CLK_LOOKUP("gsbi_qup_clk", gsbi7_qup_clk.c, "qup_i2c.4"),
3502 CLK_LOOKUP("gsbi_qup_clk", gsbi8_qup_clk.c, "qup_i2c.3"),
3503 CLK_LOOKUP("gsbi_qup_clk", gsbi9_qup_clk.c, "qup_i2c.2"),
3504 CLK_LOOKUP("spi_clk", gsbi10_qup_clk.c, "spi_qsd.1"),
3505 CLK_LOOKUP("gsbi_qup_clk", gsbi11_qup_clk.c, NULL),
3506 CLK_LOOKUP("gsbi_qup_clk", gsbi12_qup_clk.c, "msm_dsps.0"),
3507 CLK_LOOKUP("gsbi_qup_clk", gsbi12_qup_clk.c, "qup_i2c.5"),
3508 CLK_LOOKUP("pdm_clk", pdm_clk.c, NULL),
3509 CLK_LOOKUP("pmem_clk", pmem_clk.c, NULL),
3510 CLK_LOOKUP("prng_clk", prng_clk.c, NULL),
3511 CLK_LOOKUP("sdc_clk", sdc1_clk.c, "msm_sdcc.1"),
3512 CLK_LOOKUP("sdc_clk", sdc2_clk.c, "msm_sdcc.2"),
3513 CLK_LOOKUP("sdc_clk", sdc3_clk.c, "msm_sdcc.3"),
3514 CLK_LOOKUP("sdc_clk", sdc4_clk.c, "msm_sdcc.4"),
3515 CLK_LOOKUP("sdc_clk", sdc5_clk.c, "msm_sdcc.5"),
3516 CLK_LOOKUP("tsif_ref_clk", tsif_ref_clk.c, NULL),
3517 CLK_LOOKUP("tssc_clk", tssc_clk.c, NULL),
3518 CLK_LOOKUP("usb_hs_clk", usb_hs1_xcvr_clk.c, NULL),
3519 CLK_LOOKUP("usb_phy_clk", usb_phy0_clk.c, NULL),
3520 CLK_LOOKUP("usb_fs_clk", usb_fs1_xcvr_clk.c, NULL),
3521 CLK_LOOKUP("usb_fs_sys_clk", usb_fs1_sys_clk.c, NULL),
3522 CLK_LOOKUP("usb_fs_src_clk", usb_fs1_src_clk.c, NULL),
3523 CLK_LOOKUP("usb_fs_clk", usb_fs2_xcvr_clk.c, NULL),
3524 CLK_LOOKUP("usb_fs_sys_clk", usb_fs2_sys_clk.c, NULL),
3525 CLK_LOOKUP("usb_fs_src_clk", usb_fs2_src_clk.c, NULL),
3526 CLK_LOOKUP("ce_clk", ce2_p_clk.c, NULL),
3527 CLK_LOOKUP("spi_pclk", gsbi1_p_clk.c, "spi_qsd.0"),
3528 CLK_LOOKUP("gsbi_pclk", gsbi2_p_clk.c, NULL),
3529 CLK_LOOKUP("gsbi_pclk", gsbi3_p_clk.c, "msm_serial_hsl.2"),
3530 CLK_LOOKUP("gsbi_pclk", gsbi3_p_clk.c, "qup_i2c.0"),
3531 CLK_LOOKUP("gsbi_pclk", gsbi4_p_clk.c, "qup_i2c.1"),
3532 CLK_LOOKUP("gsbi_pclk", gsbi5_p_clk.c, NULL),
3533 CLK_LOOKUP("uartdm_pclk", gsbi6_p_clk.c, "msm_serial_hs.0"),
3534 CLK_LOOKUP("gsbi_pclk", gsbi7_p_clk.c, "qup_i2c.4"),
3535 CLK_LOOKUP("gsbi_pclk", gsbi8_p_clk.c, "qup_i2c.3"),
3536 CLK_LOOKUP("gsbi_pclk", gsbi9_p_clk.c, "msm_serial_hsl.1"),
3537 CLK_LOOKUP("gsbi_pclk", gsbi9_p_clk.c, "qup_i2c.2"),
3538 CLK_LOOKUP("spi_pclk", gsbi10_p_clk.c, "spi_qsd.1"),
3539 CLK_LOOKUP("gsbi_pclk", gsbi11_p_clk.c, NULL),
3540 CLK_LOOKUP("gsbi_pclk", gsbi12_p_clk.c, "msm_dsps.0"),
3541 CLK_LOOKUP("gsbi_pclk", gsbi12_p_clk.c, "msm_serial_hsl.0"),
3542 CLK_LOOKUP("gsbi_pclk", gsbi12_p_clk.c, "qup_i2c.5"),
3543 CLK_LOOKUP("ppss_pclk", ppss_p_clk.c, NULL),
3544 CLK_LOOKUP("tsif_pclk", tsif_p_clk.c, NULL),
3545 CLK_LOOKUP("usb_fs_pclk", usb_fs1_p_clk.c, NULL),
3546 CLK_LOOKUP("usb_fs_pclk", usb_fs2_p_clk.c, NULL),
3547 CLK_LOOKUP("usb_hs_pclk", usb_hs1_p_clk.c, NULL),
3548 CLK_LOOKUP("sdc_pclk", sdc1_p_clk.c, "msm_sdcc.1"),
3549 CLK_LOOKUP("sdc_pclk", sdc2_p_clk.c, "msm_sdcc.2"),
3550 CLK_LOOKUP("sdc_pclk", sdc3_p_clk.c, "msm_sdcc.3"),
3551 CLK_LOOKUP("sdc_pclk", sdc4_p_clk.c, "msm_sdcc.4"),
3552 CLK_LOOKUP("sdc_pclk", sdc5_p_clk.c, "msm_sdcc.5"),
3553 CLK_LOOKUP("adm_clk", adm0_clk.c, "msm_dmov.0"),
3554 CLK_LOOKUP("adm_pclk", adm0_p_clk.c, "msm_dmov.0"),
3555 CLK_LOOKUP("adm_clk", adm1_clk.c, "msm_dmov.1"),
3556 CLK_LOOKUP("adm_pclk", adm1_p_clk.c, "msm_dmov.1"),
3557 CLK_LOOKUP("modem_ahb1_pclk", modem_ahb1_p_clk.c, NULL),
3558 CLK_LOOKUP("modem_ahb2_pclk", modem_ahb2_p_clk.c, NULL),
3559 CLK_LOOKUP("pmic_arb_pclk", pmic_arb0_p_clk.c, NULL),
3560 CLK_LOOKUP("pmic_arb_pclk", pmic_arb1_p_clk.c, NULL),
3561 CLK_LOOKUP("pmic_ssbi2", pmic_ssbi2_clk.c, NULL),
3562 CLK_LOOKUP("rpm_msg_ram_pclk", rpm_msg_ram_p_clk.c, NULL),
3563 CLK_LOOKUP("amp_clk", amp_clk.c, NULL),
3564 CLK_LOOKUP("cam_clk", cam_clk.c, NULL),
3565 CLK_LOOKUP("csi_clk", csi0_clk.c, NULL),
3566 CLK_LOOKUP("csi_clk", csi1_clk.c, "msm_camera_ov7692.0"),
3567 CLK_LOOKUP("csi_clk", csi1_clk.c, "msm_camera_ov9726.0"),
3568 CLK_LOOKUP("csi_src_clk", csi_src_clk.c, NULL),
3569 CLK_LOOKUP("dsi_byte_div_clk", dsi_byte_clk.c, NULL),
3570 CLK_LOOKUP("dsi_esc_clk", dsi_esc_clk.c, NULL),
3571 CLK_LOOKUP("gfx2d0_clk", gfx2d0_clk.c, NULL),
3572 CLK_LOOKUP("gfx2d1_clk", gfx2d1_clk.c, NULL),
3573 CLK_LOOKUP("gfx3d_clk", gfx3d_clk.c, NULL),
3574 CLK_LOOKUP("ijpeg_clk", ijpeg_clk.c, NULL),
3575 CLK_LOOKUP("jpegd_clk", jpegd_clk.c, NULL),
3576 CLK_LOOKUP("mdp_clk", mdp_clk.c, NULL),
3577 CLK_LOOKUP("mdp_vsync_clk", mdp_vsync_clk.c, NULL),
3578 CLK_LOOKUP("pixel_lcdc_clk", pixel_lcdc_clk.c, NULL),
3579 CLK_LOOKUP("pixel_mdp_clk", pixel_mdp_clk.c, NULL),
3580 CLK_LOOKUP("rot_clk", rot_clk.c, NULL),
3581 CLK_LOOKUP("tv_enc_clk", tv_enc_clk.c, NULL),
3582 CLK_LOOKUP("tv_dac_clk", tv_dac_clk.c, NULL),
3583 CLK_LOOKUP("vcodec_clk", vcodec_clk.c, NULL),
3584 CLK_LOOKUP("mdp_tv_clk", mdp_tv_clk.c, NULL),
3585 CLK_LOOKUP("hdmi_clk", hdmi_tv_clk.c, NULL),
3586 CLK_LOOKUP("tv_src_clk", tv_src_clk.c, NULL),
3587 CLK_LOOKUP("hdmi_app_clk", hdmi_app_clk.c, NULL),
3588 CLK_LOOKUP("vpe_clk", vpe_clk.c, NULL),
3589 CLK_LOOKUP("csi_vfe_clk", csi0_vfe_clk.c, NULL),
3590 CLK_LOOKUP("csi_vfe_clk", csi1_vfe_clk.c, "msm_camera_ov7692.0"),
3591 CLK_LOOKUP("csi_vfe_clk", csi1_vfe_clk.c, "msm_camera_ov9726.0"),
3592 CLK_LOOKUP("vfe_clk", vfe_clk.c, NULL),
3593 CLK_LOOKUP("smmu_jpegd_clk", jpegd_axi_clk.c, NULL),
3594 CLK_LOOKUP("smmu_vfe_clk", vfe_axi_clk.c, NULL),
3595 CLK_LOOKUP("vfe_axi_clk", vfe_axi_clk.c, NULL),
3596 CLK_LOOKUP("ijpeg_axi_clk", ijpeg_axi_clk.c, NULL),
3597 CLK_LOOKUP("imem_axi_clk", imem_axi_clk.c, NULL),
3598 CLK_LOOKUP("mdp_axi_clk", mdp_axi_clk.c, NULL),
3599 CLK_LOOKUP("rot_axi_clk", rot_axi_clk.c, NULL),
3600 CLK_LOOKUP("vcodec_axi_clk", vcodec_axi_clk.c, NULL),
3601 CLK_LOOKUP("vpe_axi_clk", vpe_axi_clk.c, NULL),
3602 CLK_LOOKUP("amp_pclk", amp_p_clk.c, NULL),
3603 CLK_LOOKUP("csi_pclk", csi0_p_clk.c, NULL),
3604 CLK_LOOKUP("csi_pclk", csi1_p_clk.c, "msm_camera_ov7692.0"),
3605 CLK_LOOKUP("csi_pclk", csi1_p_clk.c, "msm_camera_ov9726.0"),
3606 CLK_LOOKUP("dsi_m_pclk", dsi_m_p_clk.c, NULL),
3607 CLK_LOOKUP("dsi_s_pclk", dsi_s_p_clk.c, NULL),
3608 CLK_LOOKUP("gfx2d0_pclk", gfx2d0_p_clk.c, NULL),
3609 CLK_LOOKUP("gfx2d1_pclk", gfx2d1_p_clk.c, NULL),
3610 CLK_LOOKUP("gfx3d_pclk", gfx3d_p_clk.c, NULL),
3611 CLK_LOOKUP("hdmi_m_pclk", hdmi_m_p_clk.c, NULL),
3612 CLK_LOOKUP("hdmi_s_pclk", hdmi_s_p_clk.c, NULL),
3613 CLK_LOOKUP("ijpeg_pclk", ijpeg_p_clk.c, NULL),
3614 CLK_LOOKUP("jpegd_pclk", jpegd_p_clk.c, NULL),
3615 CLK_LOOKUP("imem_pclk", imem_p_clk.c, NULL),
3616 CLK_LOOKUP("mdp_pclk", mdp_p_clk.c, NULL),
3617 CLK_LOOKUP("smmu_pclk", smmu_p_clk.c, NULL),
3618 CLK_LOOKUP("rotator_pclk", rot_p_clk.c, NULL),
3619 CLK_LOOKUP("tv_enc_pclk", tv_enc_p_clk.c, NULL),
3620 CLK_LOOKUP("vcodec_pclk", vcodec_p_clk.c, NULL),
3621 CLK_LOOKUP("vfe_pclk", vfe_p_clk.c, NULL),
3622 CLK_LOOKUP("vpe_pclk", vpe_p_clk.c, NULL),
3623 CLK_LOOKUP("mi2s_osr_clk", mi2s_osr_clk.c, NULL),
3624 CLK_LOOKUP("mi2s_bit_clk", mi2s_bit_clk.c, NULL),
3625 CLK_LOOKUP("i2s_mic_osr_clk", codec_i2s_mic_osr_clk.c, NULL),
3626 CLK_LOOKUP("i2s_mic_bit_clk", codec_i2s_mic_bit_clk.c, NULL),
3627 CLK_LOOKUP("i2s_mic_osr_clk", spare_i2s_mic_osr_clk.c, NULL),
3628 CLK_LOOKUP("i2s_mic_bit_clk", spare_i2s_mic_bit_clk.c, NULL),
3629 CLK_LOOKUP("i2s_spkr_osr_clk", codec_i2s_spkr_osr_clk.c, NULL),
3630 CLK_LOOKUP("i2s_spkr_bit_clk", codec_i2s_spkr_bit_clk.c, NULL),
3631 CLK_LOOKUP("i2s_spkr_osr_clk", spare_i2s_spkr_osr_clk.c, NULL),
3632 CLK_LOOKUP("i2s_spkr_bit_clk", spare_i2s_spkr_bit_clk.c, NULL),
3633 CLK_LOOKUP("pcm_clk", pcm_clk.c, NULL),
3634 CLK_LOOKUP("iommu_clk", jpegd_axi_clk.c, "msm_iommu.0"),
3635 CLK_LOOKUP("iommu_clk", mdp_axi_clk.c, "msm_iommu.2"),
3636 CLK_LOOKUP("iommu_clk", mdp_axi_clk.c, "msm_iommu.3"),
3637 CLK_LOOKUP("iommu_clk", ijpeg_axi_clk.c, "msm_iommu.5"),
3638 CLK_LOOKUP("iommu_clk", vfe_axi_clk.c, "msm_iommu.6"),
3639 CLK_LOOKUP("iommu_clk", vcodec_axi_clk.c, "msm_iommu.7"),
3640 CLK_LOOKUP("iommu_clk", vcodec_axi_clk.c, "msm_iommu.8"),
3641 CLK_LOOKUP("iommu_clk", gfx3d_clk.c, "msm_iommu.9"),
3642 CLK_LOOKUP("iommu_clk", gfx2d0_clk.c, "msm_iommu.10"),
3643 CLK_LOOKUP("iommu_clk", gfx2d1_clk.c, "msm_iommu.11"),
3644
3645 CLK_LOOKUP("dfab_dsps_clk", dfab_dsps_clk.c, NULL),
3646 CLK_LOOKUP("dfab_usb_hs_clk", dfab_usb_hs_clk.c, NULL),
3647 CLK_LOOKUP("dfab_sdc_clk", dfab_sdc1_clk.c, "msm_sdcc.1"),
3648 CLK_LOOKUP("dfab_sdc_clk", dfab_sdc2_clk.c, "msm_sdcc.2"),
3649 CLK_LOOKUP("dfab_sdc_clk", dfab_sdc3_clk.c, "msm_sdcc.3"),
3650 CLK_LOOKUP("dfab_sdc_clk", dfab_sdc4_clk.c, "msm_sdcc.4"),
3651 CLK_LOOKUP("dfab_sdc_clk", dfab_sdc5_clk.c, "msm_sdcc.5"),
3652
3653 CLK_LOOKUP("ebi1_msmbus_clk", ebi1_msmbus_clk.c, NULL),
3654 CLK_LOOKUP("ebi1_clk", ebi1_adm0_clk.c, "msm_dmov.0"),
3655 CLK_LOOKUP("ebi1_clk", ebi1_adm1_clk.c, "msm_dmov.1"),
3656
3657 CLK_LOOKUP("sc0_mclk", sc0_m_clk, NULL),
3658 CLK_LOOKUP("sc1_mclk", sc1_m_clk, NULL),
3659 CLK_LOOKUP("l2_mclk", l2_m_clk, NULL),
3660};
3661
3662/*
3663 * Miscellaneous clock register initializations
3664 */
3665
3666/* Read, modify, then write-back a register. */
3667static void __init rmwreg(uint32_t val, void *reg, uint32_t mask)
3668{
3669 uint32_t regval = readl_relaxed(reg);
3670 regval &= ~mask;
3671 regval |= val;
3672 writel_relaxed(regval, reg);
3673}
3674
3675static void __init reg_init(void)
3676{
3677 /* Setup MM_PLL2 (PLL3), but turn it off. Rate set by set_rate_tv(). */
3678 rmwreg(0, MM_PLL2_MODE_REG, BIT(0)); /* Disable output */
3679 /* Set ref, bypass, assert reset, disable output, disable test mode */
3680 writel_relaxed(0, MM_PLL2_MODE_REG); /* PXO */
3681 writel_relaxed(0x00800000, MM_PLL2_CONFIG_REG); /* Enable main out. */
3682
3683 /* The clock driver doesn't use SC1's voting register to control
3684 * HW-voteable clocks. Clear its bits so that disabling bits in the
3685 * SC0 register will cause the corresponding clocks to be disabled. */
3686 rmwreg(BIT(12)|BIT(11), SC0_U_CLK_BRANCH_ENA_VOTE_REG, BM(12, 11));
3687 writel_relaxed(BIT(12)|BIT(11), SC1_U_CLK_BRANCH_ENA_VOTE_REG);
3688 /* Let sc_aclk and sc_clk halt when both Scorpions are collapsed. */
3689 writel_relaxed(BIT(12)|BIT(11), SC0_U_CLK_SLEEP_ENA_VOTE_REG);
3690 writel_relaxed(BIT(12)|BIT(11), SC1_U_CLK_SLEEP_ENA_VOTE_REG);
3691
3692 /* Deassert MM SW_RESET_ALL signal. */
3693 writel_relaxed(0, SW_RESET_ALL_REG);
3694
3695 /* Initialize MM AHB registers: Enable the FPB clock and disable HW
3696 * gating for all clocks. Also set VFE_AHB's FORCE_CORE_ON bit to
3697 * prevent its memory from being collapsed when the clock is halted.
3698 * The sleep and wake-up delays are set to safe values. */
3699 rmwreg(0x00000003, AHB_EN_REG, 0x0F7FFFFF);
3700 rmwreg(0x000007F9, AHB_EN2_REG, 0x7FFFBFFF);
3701
3702 /* Deassert all locally-owned MM AHB resets. */
3703 rmwreg(0, SW_RESET_AHB_REG, 0xFFF7DFFF);
3704
3705 /* Initialize MM AXI registers: Enable HW gating for all clocks that
3706 * support it. Also set FORCE_CORE_ON bits, and any sleep and wake-up
3707 * delays to safe values. */
3708 rmwreg(0x000207F9, MAXI_EN_REG, 0x0FFFFFFF);
3709 /* MAXI_EN2_REG is owned by the RPM. Don't touch it. */
3710 writel_relaxed(0x3FE7FCFF, MAXI_EN3_REG);
3711 writel_relaxed(0x000001D8, SAXI_EN_REG);
3712
3713 /* Initialize MM CC registers: Set MM FORCE_CORE_ON bits so that core
3714 * memories retain state even when not clocked. Also, set sleep and
3715 * wake-up delays to safe values. */
3716 writel_relaxed(0x00000000, CSI_CC_REG);
3717 rmwreg(0x00000000, MISC_CC_REG, 0xFEFFF3FF);
3718 rmwreg(0x000007FD, MISC_CC2_REG, 0xFFFF7FFF);
3719 writel_relaxed(0x80FF0000, GFX2D0_CC_REG);
3720 writel_relaxed(0x80FF0000, GFX2D1_CC_REG);
3721 writel_relaxed(0x80FF0000, GFX3D_CC_REG);
3722 writel_relaxed(0x80FF0000, IJPEG_CC_REG);
3723 writel_relaxed(0x80FF0000, JPEGD_CC_REG);
3724 /* MDP and PIXEL clocks may be running at boot, don't turn them off. */
3725 rmwreg(0x80FF0000, MDP_CC_REG, BM(31, 29) | BM(23, 16));
3726 rmwreg(0x80FF0000, PIXEL_CC_REG, BM(31, 29) | BM(23, 16));
3727 writel_relaxed(0x000004FF, PIXEL_CC2_REG);
3728 writel_relaxed(0x80FF0000, ROT_CC_REG);
3729 writel_relaxed(0x80FF0000, TV_CC_REG);
3730 writel_relaxed(0x000004FF, TV_CC2_REG);
3731 writel_relaxed(0xC0FF0000, VCODEC_CC_REG);
3732 writel_relaxed(0x80FF0000, VFE_CC_REG);
3733 writel_relaxed(0x80FF0000, VPE_CC_REG);
3734
3735 /* De-assert MM AXI resets to all hardware blocks. */
3736 writel_relaxed(0, SW_RESET_AXI_REG);
3737
3738 /* Deassert all MM core resets. */
3739 writel_relaxed(0, SW_RESET_CORE_REG);
3740
3741 /* Reset 3D core once more, with its clock enabled. This can
3742 * eventually be done as part of the GDFS footswitch driver. */
3743 clk_set_rate(&gfx3d_clk.c, 27000000);
3744 clk_enable(&gfx3d_clk.c);
3745 writel_relaxed(BIT(12), SW_RESET_CORE_REG);
3746 mb();
3747 udelay(5);
3748 writel_relaxed(0, SW_RESET_CORE_REG);
3749 /* Make sure reset is de-asserted before clock is disabled. */
3750 mb();
3751 clk_disable(&gfx3d_clk.c);
3752
3753 /* Enable TSSC and PDM PXO sources. */
3754 writel_relaxed(BIT(11), TSSC_CLK_CTL_REG);
3755 writel_relaxed(BIT(15), PDM_CLK_NS_REG);
3756 /* Set the dsi_byte_clk src to the DSI PHY PLL,
3757 * dsi_esc_clk to PXO/2, and the hdmi_app_clk src to PXO */
3758 rmwreg(0x400001, MISC_CC2_REG, 0x424003);
3759}
3760
3761/* Local clock driver initialization. */
3762void __init msm8660_clock_init(void)
3763{
3764 soc_update_sys_vdd = msm8660_update_sys_vdd;
3765 xo_pxo = msm_xo_get(MSM_XO_PXO, "clock-8x60");
3766 if (IS_ERR(xo_pxo)) {
3767 pr_err("%s: msm_xo_get(PXO) failed.\n", __func__);
3768 BUG();
3769 }
3770 xo_cxo = msm_xo_get(MSM_XO_TCXO_D1, "clock-8x60");
3771 if (IS_ERR(xo_cxo)) {
3772 pr_err("%s: msm_xo_get(CXO) failed.\n", __func__);
3773 BUG();
3774 }
3775
3776 local_vote_sys_vdd(HIGH);
3777 /* Initialize clock registers. */
3778 reg_init();
3779
3780 /* Initialize rates for clocks that only support one. */
3781 clk_set_rate(&pdm_clk.c, 27000000);
3782 clk_set_rate(&prng_clk.c, 64000000);
3783 clk_set_rate(&mdp_vsync_clk.c, 27000000);
3784 clk_set_rate(&tsif_ref_clk.c, 105000);
3785 clk_set_rate(&tssc_clk.c, 27000000);
3786 clk_set_rate(&usb_hs1_xcvr_clk.c, 60000000);
3787 clk_set_rate(&usb_fs1_src_clk.c, 60000000);
3788 clk_set_rate(&usb_fs2_src_clk.c, 60000000);
3789
3790 /* The halt status bits for PDM and TSSC may be incorrect at boot.
3791 * Toggle these clocks on and off to refresh them. */
Matt Wagantall0625ea02011-07-13 18:51:56 -07003792 rcg_clk_enable(&pdm_clk.c);
3793 rcg_clk_disable(&pdm_clk.c);
3794 rcg_clk_enable(&tssc_clk.c);
3795 rcg_clk_disable(&tssc_clk.c);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07003796
3797 msm_clock_init(msm_clocks_8x60, ARRAY_SIZE(msm_clocks_8x60));
3798}
3799
3800static int __init msm_clk_soc_late_init(void)
3801{
3802 int rc;
3803
3804 /* Vote for MMFPB to be at least 64MHz when an Apps CPU is active. */
3805 struct clk *mmfpb_a_clk = clk_get(NULL, "mmfpb_a_clk");
3806 if (WARN(IS_ERR(mmfpb_a_clk), "mmfpb_a_clk not found (%ld)\n",
3807 PTR_ERR(mmfpb_a_clk)))
3808 return PTR_ERR(mmfpb_a_clk);
3809 rc = clk_set_min_rate(mmfpb_a_clk, 64000000);
3810 if (WARN(rc, "mmfpb_a_clk rate was not set (%d)\n", rc))
3811 return rc;
3812 rc = clk_enable(mmfpb_a_clk);
3813 if (WARN(rc, "mmfpb_a_clk not enabled (%d)\n", rc))
3814 return rc;
3815
3816 /* Remove temporary vote for HIGH vdd_dig. */
3817 rc = local_unvote_sys_vdd(HIGH);
3818 WARN(rc, "local_unvote_sys_vdd(HIGH) failed (%d)\n", rc);
3819
3820 return rc;
3821}
3822late_initcall(msm_clk_soc_late_init);