• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (C) 2016 Freescale Semiconductor, Inc.
4  */
5 
6 #include <common.h>
7 #include <div64.h>
8 #include <asm/io.h>
9 #include <errno.h>
10 #include <asm/arch/imx-regs.h>
11 #include <asm/arch/pcc.h>
12 #include <asm/arch/sys_proto.h>
13 
14 #define PCC_CLKSRC_TYPES 2
15 #define PCC_CLKSRC_NUM 7
16 
17 static enum scg_clk pcc_clksrc[PCC_CLKSRC_TYPES][PCC_CLKSRC_NUM] = {
18 	{	SCG_NIC1_BUS_CLK,
19 		SCG_NIC1_CLK,
20 		SCG_DDR_CLK,
21 		SCG_APLL_PFD2_CLK,
22 		SCG_APLL_PFD1_CLK,
23 		SCG_APLL_PFD0_CLK,
24 		USB_PLL_OUT,
25 	},
26 	{	SCG_SOSC_DIV2_CLK,  /* SOSC BUS clock */
27 		MIPI_PLL_OUT,
28 		SCG_FIRC_DIV2_CLK,  /* FIRC BUS clock */
29 		SCG_ROSC_CLK,
30 		SCG_NIC1_BUS_CLK,
31 		SCG_NIC1_CLK,
32 		SCG_APLL_PFD3_CLK,
33 	},
34 };
35 
36 static struct pcc_entry pcc_arrays[] = {
37 	{PCC2_RBASE, DMA1_PCC2_SLOT,		CLKSRC_NO_PCS, PCC_NO_DIV},
38 	{PCC2_RBASE, RGPIO1_PCC2_SLOT,		CLKSRC_NO_PCS, PCC_NO_DIV},
39 	{PCC2_RBASE, FLEXBUS0_PCC2_SLOT,	CLKSRC_NO_PCS, PCC_NO_DIV},
40 	{PCC2_RBASE, SEMA42_1_PCC2_SLOT,	CLKSRC_NO_PCS, PCC_NO_DIV},
41 	{PCC2_RBASE, DMA1_CH_MUX0_PCC2_SLOT,	CLKSRC_NO_PCS, PCC_NO_DIV},
42 	{PCC2_RBASE, SNVS_PCC2_SLOT,		CLKSRC_NO_PCS, PCC_NO_DIV},
43 	{PCC2_RBASE, CAAM_PCC2_SLOT,		CLKSRC_NO_PCS, PCC_NO_DIV},
44 	{PCC2_RBASE, LPTPM4_PCC2_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
45 	{PCC2_RBASE, LPTPM5_PCC2_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
46 	{PCC2_RBASE, LPIT1_PCC2_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
47 	{PCC2_RBASE, LPSPI2_PCC2_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
48 	{PCC2_RBASE, LPSPI3_PCC2_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
49 	{PCC2_RBASE, LPI2C4_PCC2_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
50 	{PCC2_RBASE, LPI2C5_PCC2_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
51 	{PCC2_RBASE, LPUART4_PCC2_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
52 	{PCC2_RBASE, LPUART5_PCC2_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
53 	{PCC2_RBASE, FLEXIO1_PCC2_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
54 	{PCC2_RBASE, USBOTG0_PCC2_SLOT,		CLKSRC_PER_PLAT, PCC_HAS_DIV},
55 	{PCC2_RBASE, USBOTG1_PCC2_SLOT,		CLKSRC_PER_PLAT, PCC_HAS_DIV},
56 	{PCC2_RBASE, USBPHY_PCC2_SLOT,		CLKSRC_NO_PCS, PCC_NO_DIV},
57 	{PCC2_RBASE, USB_PL301_PCC2_SLOT,	CLKSRC_NO_PCS, PCC_NO_DIV},
58 	{PCC2_RBASE, USDHC0_PCC2_SLOT,		CLKSRC_PER_PLAT, PCC_HAS_DIV},
59 	{PCC2_RBASE, USDHC1_PCC2_SLOT,		CLKSRC_PER_PLAT, PCC_HAS_DIV},
60 	{PCC2_RBASE, WDG1_PCC2_SLOT,		CLKSRC_PER_BUS,	PCC_HAS_DIV},
61 	{PCC2_RBASE, WDG2_PCC2_SLOT,		CLKSRC_PER_BUS, PCC_HAS_DIV},
62 
63 	{PCC3_RBASE, LPTPM6_PCC3_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
64 	{PCC3_RBASE, LPTPM7_PCC3_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
65 	{PCC3_RBASE, LPI2C6_PCC3_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
66 	{PCC3_RBASE, LPI2C7_PCC3_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
67 	{PCC3_RBASE, LPUART6_PCC3_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
68 	{PCC3_RBASE, LPUART7_PCC3_SLOT,		CLKSRC_PER_BUS, PCC_NO_DIV},
69 	{PCC3_RBASE, VIU0_PCC3_SLOT,		CLKSRC_NO_PCS, PCC_NO_DIV},
70 	{PCC3_RBASE, DSI0_PCC3_SLOT,		CLKSRC_PER_BUS, PCC_HAS_DIV},
71 	{PCC3_RBASE, LCDIF0_PCC3_SLOT,		CLKSRC_PER_PLAT, PCC_HAS_DIV},
72 	{PCC3_RBASE, MMDC0_PCC3_SLOT,		CLKSRC_NO_PCS, PCC_NO_DIV},
73 	{PCC3_RBASE, PORTC_PCC3_SLOT,		CLKSRC_NO_PCS, PCC_NO_DIV},
74 	{PCC3_RBASE, PORTD_PCC3_SLOT,		CLKSRC_NO_PCS, PCC_NO_DIV},
75 	{PCC3_RBASE, PORTE_PCC3_SLOT,		CLKSRC_NO_PCS, PCC_NO_DIV},
76 	{PCC3_RBASE, PORTF_PCC3_SLOT,		CLKSRC_NO_PCS, PCC_NO_DIV},
77 	{PCC3_RBASE, GPU3D_PCC3_SLOT,		CLKSRC_PER_PLAT, PCC_NO_DIV},
78 	{PCC3_RBASE, GPU2D_PCC3_SLOT,		CLKSRC_PER_PLAT, PCC_NO_DIV},
79 };
80 
pcc_clock_enable(enum pcc_clk clk,bool enable)81 int pcc_clock_enable(enum pcc_clk clk, bool enable)
82 {
83 	u32 reg, val;
84 
85 	if (clk >= ARRAY_SIZE(pcc_arrays))
86 		return -EINVAL;
87 
88 	reg = pcc_arrays[clk].pcc_base + pcc_arrays[clk].pcc_slot * 4;
89 
90 	val = readl(reg);
91 
92 	clk_debug("pcc_clock_enable: clk %d, reg 0x%x, val 0x%x, enable %d\n",
93 		  clk, reg, val, enable);
94 
95 	if (!(val & PCC_PR_MASK) || (val & PCC_INUSE_MASK))
96 		return -EPERM;
97 
98 	if (enable)
99 		val |= PCC_CGC_MASK;
100 	else
101 		val &= ~PCC_CGC_MASK;
102 
103 	writel(val, reg);
104 
105 	clk_debug("pcc_clock_enable: val 0x%x\n", val);
106 
107 	return 0;
108 }
109 
110 /* The clock source select needs clock is disabled */
pcc_clock_sel(enum pcc_clk clk,enum scg_clk src)111 int pcc_clock_sel(enum pcc_clk clk, enum scg_clk src)
112 {
113 	u32 reg, val, i, clksrc_type;
114 
115 	if (clk >= ARRAY_SIZE(pcc_arrays))
116 		return -EINVAL;
117 
118 	clksrc_type = pcc_arrays[clk].clksrc;
119 	if (clksrc_type >= CLKSRC_NO_PCS) {
120 		printf("No PCS field for the PCC %d, clksrc type %d\n",
121 		       clk, clksrc_type);
122 		return -EPERM;
123 	}
124 
125 	for (i = 0; i < PCC_CLKSRC_NUM; i++) {
126 		if (pcc_clksrc[clksrc_type][i] == src) {
127 			/* Find the clock src, then set it to PCS */
128 			break;
129 		}
130 	}
131 
132 	if (i == PCC_CLKSRC_NUM) {
133 		printf("Not find the parent scg_clk in PCS of PCC %d, invalid scg_clk %d\n", clk, src);
134 		return -EINVAL;
135 	}
136 
137 	reg = pcc_arrays[clk].pcc_base + pcc_arrays[clk].pcc_slot * 4;
138 
139 	val = readl(reg);
140 
141 	clk_debug("pcc_clock_sel: clk %d, reg 0x%x, val 0x%x, clksrc_type %d\n",
142 		  clk, reg, val, clksrc_type);
143 
144 	if (!(val & PCC_PR_MASK) || (val & PCC_INUSE_MASK) ||
145 	    (val & PCC_CGC_MASK)) {
146 		printf("Not permit to select clock source val = 0x%x\n", val);
147 		return -EPERM;
148 	}
149 
150 	val &= ~PCC_PCS_MASK;
151 	val |= ((i + 1) << PCC_PCS_OFFSET);
152 
153 	writel(val, reg);
154 
155 	clk_debug("pcc_clock_sel: val 0x%x\n", val);
156 
157 	return 0;
158 }
159 
pcc_clock_div_config(enum pcc_clk clk,bool frac,u8 div)160 int pcc_clock_div_config(enum pcc_clk clk, bool frac, u8 div)
161 {
162 	u32 reg, val;
163 
164 	if (clk >= ARRAY_SIZE(pcc_arrays) || div > 8 ||
165 	    (div == 1 && frac != 0))
166 		return -EINVAL;
167 
168 	if (pcc_arrays[clk].div >= PCC_NO_DIV) {
169 		printf("No DIV/FRAC field for the PCC %d\n", clk);
170 		return -EPERM;
171 	}
172 
173 	reg = pcc_arrays[clk].pcc_base + pcc_arrays[clk].pcc_slot * 4;
174 
175 	val = readl(reg);
176 
177 	if (!(val & PCC_PR_MASK) || (val & PCC_INUSE_MASK) ||
178 	    (val & PCC_CGC_MASK)) {
179 		printf("Not permit to set div/frac val = 0x%x\n", val);
180 		return -EPERM;
181 	}
182 
183 	if (frac)
184 		val |= PCC_FRAC_MASK;
185 	else
186 		val &= ~PCC_FRAC_MASK;
187 
188 	val &= ~PCC_PCD_MASK;
189 	val |= (div - 1) & PCC_PCD_MASK;
190 
191 	writel(val, reg);
192 
193 	return 0;
194 }
195 
pcc_clock_is_enable(enum pcc_clk clk)196 bool pcc_clock_is_enable(enum pcc_clk clk)
197 {
198 	u32 reg, val;
199 
200 	if (clk >= ARRAY_SIZE(pcc_arrays))
201 		return -EINVAL;
202 
203 	reg = pcc_arrays[clk].pcc_base + pcc_arrays[clk].pcc_slot * 4;
204 	val = readl(reg);
205 
206 	if ((val & PCC_INUSE_MASK) || (val & PCC_CGC_MASK))
207 		return true;
208 
209 	return false;
210 }
211 
pcc_clock_get_clksrc(enum pcc_clk clk,enum scg_clk * src)212 int pcc_clock_get_clksrc(enum pcc_clk clk, enum scg_clk *src)
213 {
214 	u32 reg, val, clksrc_type;
215 
216 	if (clk >= ARRAY_SIZE(pcc_arrays))
217 		return -EINVAL;
218 
219 	clksrc_type = pcc_arrays[clk].clksrc;
220 	if (clksrc_type >= CLKSRC_NO_PCS) {
221 		printf("No PCS field for the PCC %d, clksrc type %d\n",
222 		       clk, clksrc_type);
223 		return -EPERM;
224 	}
225 
226 	reg = pcc_arrays[clk].pcc_base + pcc_arrays[clk].pcc_slot * 4;
227 
228 	val = readl(reg);
229 
230 	clk_debug("pcc_clock_get_clksrc: clk %d, reg 0x%x, val 0x%x, type %d\n",
231 		  clk, reg, val, clksrc_type);
232 
233 	if (!(val & PCC_PR_MASK)) {
234 		printf("This pcc slot is not present = 0x%x\n", val);
235 		return -EPERM;
236 	}
237 
238 	val &= PCC_PCS_MASK;
239 	val = (val >> PCC_PCS_OFFSET);
240 
241 	if (!val) {
242 		printf("Clock source is off\n");
243 		return -EIO;
244 	}
245 
246 	*src = pcc_clksrc[clksrc_type][val - 1];
247 
248 	clk_debug("pcc_clock_get_clksrc: parent scg clk %d\n", *src);
249 
250 	return 0;
251 }
252 
pcc_clock_get_rate(enum pcc_clk clk)253 u32 pcc_clock_get_rate(enum pcc_clk clk)
254 {
255 	u32 reg, val, rate, frac, div;
256 	enum scg_clk parent;
257 	int ret;
258 
259 	ret = pcc_clock_get_clksrc(clk, &parent);
260 	if (ret)
261 		return 0;
262 
263 	rate = scg_clk_get_rate(parent);
264 
265 	clk_debug("pcc_clock_get_rate: parent rate %u\n", rate);
266 
267 	if (pcc_arrays[clk].div == PCC_HAS_DIV) {
268 		reg = pcc_arrays[clk].pcc_base + pcc_arrays[clk].pcc_slot * 4;
269 		val = readl(reg);
270 
271 		frac = (val & PCC_FRAC_MASK) >> PCC_FRAC_OFFSET;
272 		div = (val & PCC_PCD_MASK) >> PCC_PCD_OFFSET;
273 
274 		/*
275 		 * Theoretically don't have overflow in the calc,
276 		 * the rate won't exceed 2G
277 		 */
278 		rate = rate * (frac + 1) / (div + 1);
279 	}
280 
281 	clk_debug("pcc_clock_get_rate: rate %u\n", rate);
282 	return rate;
283 }
284